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Abstract 

This  thesis  examines  the  application  of  artificial  neural  networks  (NNs)  to  the  problem  of 
dynamic  flight  control.  The  speciflc  application  is  the  control  of  a  flying  model  helicopter.  The 
control  interface  is  provided  through  a  hardware  and  software  test  bed  called  the  Fast  Adaptive 
Maneuvering  Experiment  (FAME).  The  NN  design  approach  uses  two  NNs:  one  trained  as  an 
emulator  of  the  plant  and  the  other  trained  to  control  the  emulator.  The  emulator  neural  network 
is  designed  to  reproduce  the  flight  dynamics  of  the  experimental  plant.  The  controller  is  then 
designed  to  produce  the  appropriate  control  inputs  to  drive  the  emulator  to  a  desired  final  state. 

Previous  research  in  the  area  of  NNs  for  controls  has  almost  exclusively  been  applied  to 
simulations.  To  develop  a  controller  for  a  real  plant,  a  neural  network  must  be  created  which  will 
accurately  recreate  the  dynamics  of  the  plant.  This  thesis  demonstrates  the  ability  of  a  neural 
network  to  emulate  a  real,  dynamic,  nonlinear  plant. 
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Neural  Networks  for  Dynamic  Flight  Control 


I.  Introduction 

1.1  Overview 

Automated  aircraft  control  is  obviously  a  vital  concern  to  the  US  Air  Force.  Higher  aircraft 
performance  requires  an  increasing  reliance  on  automated  control  systems.  No  where  is  this  more 
evident  than  in  helicopter  control.  Inherently  unstable,  helicopters  are  difiScult  to  control  under 
the  best  of  circumstances.  When  performance  is  stretched  to  the  limit,  instability  problems  are 
often  beyond  the  capability  of  the  pilot. 

With  the  abilfcy  to  model  non-linear,  dynamic  systems,  artificial  neural  networks  (NNs)  are 
well  suited  for  application  to  automated  helicopter  control.  The  problem  now  becomes  one  of 
designing,  testing,  and  implementing  a  NN-based  helicopter  controller. 

The  heart  of  the  problem  lies  in  application  of  neural  network-based  control  system  to  a  real 
plant.  Research  done  by  others  (23,  11, 19)  was  accomplished  using  computer  simulations  of  plants. 
The  difficulty  in  applying  these  approaches  to  the  control  of  real  plants  is  in  the  mathematical  mod¬ 
eling  necessary  to  develop  computer  simulations.  One  approach,  devised  by  Nguyen  and  Widrow 
(13)  holds  more  promise  for  application  to  a  real  plant.  This  self-learning  system  uses  two  NNs,  one 
to  control  the  plant  and  another,  a  plant  emulator,  which  is  used  to  train  the  controller  NN.  The 
emulator  NN  is  trained  to  accurately  reproduce  the  performance  of  a  complex,  nonlinear  plant. 

The  Nguyen  application  also  used  a  computer  simulation  of  a  plant.  The  actual  plant  dy¬ 
namics  were  used  in  conjunction  with  the  emulator  to  train  the  controller.  In  an  application  to 
a  real  plant,  mathematical  representation  of  the  plant  d]mamics  will  not  be  available  to  train  the 
controller  NN. 
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In  theory,  a  well  trained  emulator  NN  can  successfully  be  used  to  train  a  controller  NN. 
Thus,  the  key  to  using  this  method  is  to  successfully  train  a  neural  network  to  emulate  a  real, 
nonlinear  dynamic  plant,  such  as  a  helicopter.  Only  after  this  research  is  accomplished  can  the 
task  of  developing  a  controller  NN  be  attempted. 

Full  scale  research  is  both  time  consuming  and  costly.  Simulations  require  extensive  mathe¬ 
matical  modeling  and  computer  resources.  A  more  practical  method  is  to  scale  down  the  system 
to  permit  experimentation  in  a  laboratory  environment.  Through  the  use  of  a  flying,  scale-model 
helicopter,  the  development  of  a  NN-based  controller  that  can  maintain  a  helicopter  in  a  stable 
flight  configuration  becomes  much  more  realizable.  The  first  step  in  this  process  is  to  fully  emulate 
the  helicopter’s  performance  parameters  in  a  neural  network. 

1.2  Background 

1.2.1  Neural  Networks.  An  artificial  neural  network,  sometimes  simply  referred  to  as 
a  neural  net  (NN),  is  a  system  designed  to  emulate  the  functions,  or  supposed  functions,  of  a 
biological  neuron.  While  some  may  propose  a  NN  is  an  artificial  brain,  the  fact  is  there  is  no 
conclusive  evidence  that  an  artificial  neural  net  is  in  any  significant  way  a  representation  of  a  brain. 
However,  NNs  have  been  shown  to  possess  unique  characteristics  such  as  the  ability  for  function 
approximation  and  the  potential  for  parallel  implementation  (1:18). 

A  simple  example  of  a  neural  net  is  the  perceptron  (Figure  1).  The  perceptron  inputs  are 
weighted  and  then  summed.  With  proper  weights  installed,  the  perceptron  is  capable  of  simple 
classification  tasks. 

The  natural  evolution  of  the  perceptron  is  the  multilayer  neural  network  (Figure  2).  The  one 
property  of  multilayer  neural  networks  which  is  central  to  most  applications  in  control  is  that  such 
networks  can  generate  input/output  maps  which  can  approximate,  under  mild  assumptions,  any 
function  with  any  desired  accuracy  (1:8). 
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Figure  1.  Perceptron  (16:54) 
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The  process  of  establishing  the  proper  weights  for  a  particular  task  is  called  training.  The  most 
common  algorithm,  or  paradigm,  used  is  called  the  backward  propagation  learning  rule,  sometimes 
just  “backprop”  (16:54).  The  method  basically  compares  the  output  generated  with  an  arbitrary 
set  of  weights  to  the  set  of  desired  outputs.  The  backpropagation  algorithm  corrects  the  weights 
based  on  the  difference  between  the  actual  and  the  desired  output. 


Figure  2.  Multilayer  Perceptron  (16:54) 


1.2.2  Helicopter  Stability  and  Control.  Helicopters  Me  inherently  unstable  devices.  The 
design  of  the  helicopter  gives  it  a  great  deal  of  maneuverability,  but  also  makes  it  very  difficult  to 


Figure  3.  Suppose  the  hovering  helicopter  to  experience  a  small  forward  velocity  as  at  (a).  In¬ 
cremental  flapping  creates  a  nose-up  disc  tilt,  which  results  in  a  nose-up  pitching 
moment  on  the  aircraft...A  nose-up  attitude  develops  and  the  backward-incline  thus 
opposes  the  forward  motion  and  eventually  arrests  it,  as  in  (b)...A  backward  swing 
commences.. .exerting  a  nose-down  moment,  as  at  (c).  A  nose-down  attitude  develops 
and  the  backward  movement  is  ultimately  arrested,  as  at  (d).  The  helicopter  then  ac¬ 
celerates  forward  under  the  influence  of  the  forward  inclination  of  thrust  and  return  to 
the  situation  at  (a).  Mathematical  analysis  shows,  and  experience  confirms,  that  the 
motion  is  dynamically  unstable,  the  amplitude  increasing  steadily  if  the  aircraft  is  left 
to  itself.  (20:127) 


control.  A  classic  remark  made  by  a  student  following  his  first  attempt  to  hover  was,  “It’s  like  riding 
a  pogo  stick  over  a  floor  covered  with  greasy  ball  bearings”  (14:542).  The  instability  of  helicopters 
is  further  illustrated  in  J.  Seddon’s  description  of  Figure  3. 


In  certain  situations,  such  as  when  carrying  a  suspended  or  slung  load,  the  oscillations  can 
become  much  more  pronounced.  This  situation  develops  due  to  two  factors.  First,  the  helicopter’s 
reaction  to  control  is  often  delayed.  In  general,  a  helicopter  without  stability  augmentation  provi¬ 
sions  is  not  only  unstable,  but  its  response  to  control  input  is  slow  (14:542).  Second,  a  pilot  often 
cannot  physically  react  quickly  enough  to  correct  the  problem.  In  human  subjects  carrying  out  a 
task  on  command,  activity  in  the  association  cortex  takes  place  about  200  to  300  milliseconds  prior 
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to  movement  (18:271).  By  the  time  a  pilot  reacts,  he  is  often  compounding  rather  than  correcting 
the  problem.  This  situation  is  commonly  referred  to  as  pilot  induced  oscillation. 

With  reaction  times  measured  in  microseconds,  a  computerized  controller  is  theoretically 
capable  of  reacting  much  faster  to  these  instability  problems.  However,  conventional  control  theory 
limits  the  application  of  traditional  computerized  flight  control  systems  to  helicopters. 

1.2.3  Automated  Flight  Control.  Complex  automated  control  systems  have  been  a  neces¬ 
sity  in  fixed-wing  aircraft  for  years.  For  example,  the  F-16,  intentionally  designed  to  be  unstable 
to  obtain  better  maneuverability,  is  uncontrollable  without  computer  assistance. 

This  problem  is  compounded  in  helicopters.  The  most  notable  distinction  which  emerges  is 
that  with  flxed-wing  aircraft,  the  stability  equation  leads  to  a  simple  physical  interpretation  of  the 
motion,  but  with  the  helicopter  this  unfortunately  is  not  so,  and  as  a  consequence  it  becomes  a 
more  complicated  process.  (20:126) 

Traditional  control  theory  has  been  inadequate  for  helicopter  control  except  for  limited  ap¬ 
plications.  Autostabilizing  systems  have  in  the  past  used  mechanical  devices  integral  to  the  rotor 
(20:132).  These  systems  are  primarily  designed  to  relieve  the  pilot  of  constant  minute  control 
corrections  rather  than  act  as  true  automated  controllers. 

The  limitations  in  automated  control  are  primarily  due  to  the  linear  models  used  in  conven¬ 
tional  control  theory.  The  control  relationships  are  broken  up  into  a  series  of  linear  approximations. 
As  the  system  diverges  further  from  the  linear  solution,  the  number  of  approximations  increases. 
This  produces  two  drawbacks:  first,  the  problem  becomes  more  difficult  to  correctly  quantify,  and 
second,  the  number  of  computations  increases,  slowing  the  response  of  the  controller. 
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1.3  Resources 


1.3.1  Fast  Adaptive  Maneuvering  Experiment  (FAME).  The  Air  Force  Office  of  Scientific 
Research,  Mathematics  and  Computer  Science  branch,  began  the  study  of  applying  NN  control 
to  helicopter  flight  systems.  The  objective  of  this  research  is  to  automatically  detect  and  correct 
flight  instabilities  such  as  those  produced  by  an  oscillating  slung  load.  In  the  course  of  its  efforts, 
AFOSR  developed  a  small-scale  test  bed  designed  for  NN  experimentation  called  the  Fast  Adaptive 
Maneuvering  Experiment  (FAME). 

The  Fast  Adaptive  Maneuvering  Experiment  (FAME)  is  designed  to  provide  neural  network 
(NN)  researchers  with  a  physical,  non-linear  system  of  modest  dimensionality  with  coupled  d3mam- 
ics  (5:5).  Developed  by  Dr.  Kenneth  Hintz  at  George  Mason  University  under  contract  by  AFOSR, 
FAME  consists  of  a  Kalt  Whisper  electric  helicopter,  an  instrumented  Flitemaster  Jr.  flight  stand, 
and  a  Motorola  MC68HC11  microcontroller  unit  (MCU)  (Figure  4). 

FAME  also  includes  software  to  send  commands  to  the  control  servos  on  the  helicopter  and 
to  report  helicopter  attitude  and  position.  Previous  versions  of  the  FAME  software  (3.0  -  5.0) 
relied  on  control  inputs  from  the  keyboard.  This  made  manual  control  haphazard  at  best.  Version 
6.0  uses  the  control  pad  from  a  commercially  available  radio  control  (R/C)  flight  simulator  called 
Skylark.  This  simulation  package  includes  a  control  pad  identical  in  configuration  and  operation  to 
a  standard  R/C  transmitter.  This  allows  the  researcher  to  manually  fly  the  helicopter  with  greater 
precision.  Precise  control  of  the  helicopter  is  necessary  in  order  to  gather  accurate  data  needed  for 
training  the  NN. 

1.3.2  Neural  Network  Design.  Several  options  for  development  of  the  neural  network 
design  are  available.  The  two  most  promising  are  highlighted  below. 

Neural  Graphics.  Neural  Graphics  is  a  neural  network  simulator  developed 
by  Gregory  Tarr  during  his  Ph.D.  dissertation  (21).  The  initial  plan  was  to  use  this  software  in 
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Figure  4.  FAME  System  Components  (5:6) 
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developing  the  NN  helicopter  controller.  This  approach  u  advantageous  since  there  is  still  some 
corporate  knowledge  at  AFIT  about  Neural  Graphics.  The  primary  disadvantage  is  that  Neural 
Graphics  was  designed  to  be  a  simulator  and  primarily  is  a  learning  tool.  However,  there  has  been 
some  work  into  practical  applications  of  Neural  Graphics. 

Capt  James  B.  Calvin,  Jr.  investigated  classification  of  radar  emitters  using  Intel’s  80170NX 
chip,  the  Electronically  TVainable  Analog  Neural  Network  (ETANN)  in  his  master’s  thesis  (2). 
In  his  work,  he  produced  a  modified  version  of  Neural  Graphics  designed  to  simulate  ETANN,  a 
hardware-based  neural  network.  He  could  produce  the  NN  weights  and  run  ETANN  simulations 
by  using  Neural  Graphics. 

One  approach  is  to  follow  Capt  Calvin’s  work  and  use  Neural  Graphics  to  simulate  the 
ETANN.  By  using  this  approach,  it  will  be  possible  to  solve  the  problem  of  producing  an  interactive 
system  using  Neural  Graphics.  In  addition,  the  helicopter  NN  control  design  could  be  developed 
into  an  on-board  NN  controller  by  using  the  ETANN  integrated  chip.  Although  it  is  unlikely  this 
research  will  directly  produce  an  ETANN  implementation,  planning  along  these  lines  will  make  the 
eventual  move  to  ETANN  an  easier  task. 

The  ETANN  has  several  advantages  to  software-based  NNs.  First,  the  ETANN  is  a  much 
faster  system.  The  analog  structure  permits  information  to  literally  flow  through  the  net  rather 
than  be  iteratively  calculated  by  a  computer.  Second,  since  ETANN  is  an  IC-based  system,  this 
would  make  it  much  more  suitable  to  an  eventual  on-board  NN  application. 

The  primary  drawback  is  ETANN  weights  are  essentially  fixed  and  cannot  be  easily  updated. 
However,  this  should  not  pose  a  problem  since  the  controller  is  not  designed  to  be  adaptive  in  real 
time. 

The  primary  difference  between  this  research  and  Capt  Calvin’s  is  the  use  of  an  IBM-PC  based 
version  of  Neural  Graphics,  where  Capt  Calvin  used  the  UNIX  base  system  (Silicon  Graphics).  The 
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biggest  drawback  is  the  lower  computational  power  of  the  PC  when  compared  to  Silicon  Graphics. 
The  primary  advantage  is  the  PC  is  much  less  expensive  and  a  more  easily  transportable  system. 


Mathematical  Modeling  Software.  Another  option  is  to  use  a  mathematical 
modeling  program,  such  as  MATLAB®.  This  approach  offers  several  advantages,  including  the 
direct  manipulation  of  vector  and  matrices.  Since  it  has  a  command  level  interpreter,  the  code 
does  not  have  to  be  compiled  prior  to  running.  This  allows  changes  to  be  quickly  and  easily 
implemented.  The  primary  drawback  is  MATLAB®  is  rather  slow  when  placed  in  iterative  loops, 
such  as  those  required  in  a  NN  implementation. 

1.4  Assumptions 

In  any  simulation,  cert^  assumptions  must  be  made.  In  this  case,  since  the  plant  is  a  scale- 
model  of  an  actual  aircraft,  the  primary  assumption  is  the  model  will  adequately  represent  a  full 
scale  aircraft. 

In  particular,  the  effect  of  the  instrumentation  stand  is  considered  to  be  minimal.  While 
this  is  probably  not  a  valid  assumption,  anecdotal  reports  &om  AFOSR  indicate  the  stand  only 
dampens  the  control  response,  making  it  perform  somewhat  more  like  a  larger  model  helicopter. 

Also,  the  assumption  must  be  made  that  the  helicopter  can  be  controlled  by  a  NN  and  that 
the  NN  control  will  be  faster  than  human  control.  As  stated  earlier,  part  of  the  controllability  issue 
is  directly  related  to  the  human  reaction  time.  The  system  must  be  capable  of  reacting  faster  if  it 
is  to  be  useful. 

This  is  a  reasonable  assumption  when  considering  ETANN  typically  has  propagation  time  of 
6  microseconds  (2:17).  While  the  NN  simulation  on  Neural  Graphics  or  MATLAB®  will  be  directly 
related  to  processor  speed  and  network  size,  it  should  be  sufficient  to  exceed  normal  human  reaction 
time.  Using  an  INTEL  386  based  PC  with  a  clock  speed  of  25  Mhz,  it  should  be  possible  to  obtain 
a  propagation  time  of  less  than  1  microsecond  per  node  of  the  neural  network. 
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1.5  Scope 


The  scope  of  this  effort  will  be  limited  to  the  application  of  NN  to  dynamic  flight  control 
using  standard  classical  backpropagation  paradigms  (16).  It  will  not  investigate  different  methods 
of  backpropagation.  Since  the  focus  is  on  application  to  the  control  problem,  it  is  doubtful  whether 
another  approach  is  necessary.  The  choice  of  training  method  is  primarily  based  on  the  speed  of 
training.  The  task  here  is  to  determine  the  feasibility  of  application  of  NNs  to  a  control  task. 
Whether  using  standard  backprop  or  some  other  method  would  be  irrelavent  to  this  researdi. 

1.6  Approach 

The  first  step  in  approaching  this  problem  is  to  use  the  FAME  apparatus  to  gather  the 
necessary  training  data  for  the  NN.  Manual  control  of  the  helicopter  using  the  Skylark  Simulator 
control  pad  will  generate  the  training  data. 

At  some  point,  the  choice  of  the  best  method  of  interfacing  to  Neural  Graphics  or  MATLAB® 
must  be  made.  There  are  several  possibilities.  The  first  is  to  integrate  the  FAME  software  and  neu¬ 
ral  network  software  into  a  single,  interactive  program.  This  is  a  possibility  since  Neural  Graphics 
is  C-based  and  MATLAB®  uses  MEX-files  to  allow  commands  to  be  called  in  a  C-based  program. 
The  second  choice  is  to  use  two  computers,  with  NN  software  running  independently  of  FAME. 
However,  this  would  seem  an  unreasonable  demand  on  already  limited  resources.  The  last  and 
most  reasonable  alternative  is  to  record  training  data  using  FAME,  and  then  load  the  data  into 
the  backpropagation  routine  to  train  the  NN.  Once  trained,  the  NN  weights  would  be  loaded  into 
a  forward  propagation  routine  written  into  the  FAME  program. 

The  type  and  quantity  of  data  required  must  be  identified.  The  FAME  test  stand  reports 
pitch,  roll,  yaw  and  X-Y-Z  coordinate  position.  This  data  will  obviously  be  used  in  NN  training. 
However,  necessity  of  the  time  derivatives  of  position  inputs  (velocity  and  acceleration,  both  linear 
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and  angular)  must  also  be  considered.  Another  possibility  is  to  use  delayed  input  and  let  the  NN 
determine  the  time  derived  inputs. 

As  for  the  quantity  of  data,  one  rule  states  that  using  a  minimum  of  three  times  the  number  of 
input  features  will  give  a  rough  estimate  of  how  many  tridning  vectors  are  needed  per  class  (Foley’s 
rule)  (16).  This  rule  has  been  useful  in  pattern  recognition  problems  using  NNs,  although  it  is  still 
not  clear  on  the  applicability  to  this  particular  control  problem.  In  this  particular  researdi,  the 
quantity  of  data  required  will  be  determined  experimentally. 

1.7  Summary 

A  neural  network  is  definitely  a  candidate  for  a  fiight  control  system.  Its  ability  to  model 
nonlinear,  dynamic  systems  is  well  documented.  While  others  have  approached  the  problem  of  NN 
application  to  fiight  controls,  they  have  only  conducted  limited  simulations.  None  have  applied 
their  research  even  on  a  small  scale  to  an  actual  fi3ring  platform. 

The  most  promising  approach  to  developing  a  NN-based  controller  for  a  real  aircraft  is  a  self¬ 
learning  system.  In  this  two-stage  process,  the  key  lies  in  the  development  of  NN  which  accurately 
reproduces  its  flight  djmamics. 

The  NN  research  at  AFIT  has  focused  primarily  on  pattern  recognition  problems,  which  are 
not,  in  general,  directly  applicable  to  control  problems.  On  the  other  hand,  the  AFIT  controls 
research  has  not  approached  the  possibility  of  using  neural  networks.  Research  into  this  helicopter 
control  problem  can  bridge  the  gap  between  these  two  areas,  opening  the  door  to  new  perspectives 
and  unique  solutions. 
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11.  Literature  Review 


This  chapter  examines  some  of  the  current  literature  in  the  area  of  neural  network  applications 
to  control  problems.  It  begins  by  first  reviewing  the  area  of  neural  networks  in  controls  in  general, 
then  examines  the  application  of  NNs  to  the  specific  area  of  flight  control. 

The  particular  application  of  concern  is  NN  control  of  a  physically  realizable  system,  in  this 
case,  a  flying  scale  model  helicopter.  This  system  is  a  particular  challenge  to  automated  control  due 
to  the  extent  of  nonlinear  relations  between  control  input  and  aircraft  response.  The  ability  of  NN 
to  handle  not  only  the  nonlinearities  of  control,  but  to  also  “leam”  the  correct  control  maneuvers 
has  made  it  a  prime  candidate  for  a  flight  control  system. 

Other  researchers  have  examined  the  issue  of  NN  control  of  aircraft.  Narendra  and  Mukhopad- 
hyay  developed  a  NN  control  system  using  the  dynamics  of  a  helicopter  as  the  plant  (11).  In  his 
research,  Schley  used  a  simplified  mathematical  model  of  an  aircraft  landing  in  the  presence  of  severe 
wind  gusts  (19).  Unfortunately,  both  applications  have  only  examined  computerized  simulations 
of  aircraft. 

2.1  Analysis  and  Application  of  Neural  Networks  for  Self-Learning  Control  Systems 

This  section  examines  the  self-learning  neural  network  control  system  devised  by  Nguyen 
and  Widrow  (13).  In  this  system,  two  separate  neural  networks  (NNs),  a  plant  emulator  and  a 
controller,  are  used.  The  plant  emulator  is  first  trained  to  predict  the  next  state,  or  position,  of 
the  plant  based  on  control  and  present  position  inputs.  During  the  controller  training  process, 
the  controller  NN  drives  the  trained  emulator  NN  through  a  series  of  trials.  In  this  process,  the 
emulator’s  final  position  error  is  backpropagated  through  the  emulator  NN  to  produce  an  error  to 
be  used  for  the  controller  training. 

The  Nguyen  system  lends  itself  well  to  the  problem  of  helicopter  control.  Since  the  emulator 
fully  parameterizes  the  plant,  the  necessity  of  precise  control  data  is  negated.  That  is,  when  using  a 
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single  NN,  the  controller  network  be  trained  in  a  single  stage,  requiring  precise  data  on  the  control 
inputs  that  would  drive  the  plant  to  the  desired  final  state.  This  necessitates  precise  manual  flight 
control,  a  rigorous  and  time  consuming  process  requiring  a  highly  skilled  pilot. 

This  is  similar  to  the  controller  developed  for  a  turbogenerator  by  Wu  and  others  (23).  The 
primary  difference  is  the  Wu  emulator  and  controller  are  tr^ed  simultaneously  in  the  case  of  the 
turbogenerator.  This  control  system  uses  two  subnetworks,  one  for  input-output  (10)  mapping  and 
the  other  for  control.  The  10  mapper,  or  neural  network  mapper  (NNM),  uses  the  errors  between 
the  plant  and  the  network  output  to  update  the  training  weights.  Next  the  neural  network  controller 
(NNC)  uses  the  updated  NNM  weights  to  modify  its  own  weights.  However,  this  application  is  again 
applied  to  a  simulated  plant. 

2.2  Background:  Truck  Backer  Upper 

The  controller  in  the  Nguyen  application  backs  a  simulated  tractor-trailer  from  some  arbitrary 
point  to  the  final  desired  location  and  orientation  at  a  loading  dock.  The  objective  is  to  train  the 
controller  to  produce  the  correct  signal  uk  to  drive  the  plant  to  the  desired  final  state  zj  given  the 
current  state  of  the  plant  2*  (Figure  5). 

The  controller  in  this  system  is  developed  in  a  two-stage  process.  The  first  stage  is  a  fairly 
straight  forward  backpropagation  problem.  The  emulator  NN  is  trained  to  map  the  state  and  control 
inputs  to  the  correct  next  state  of  the  plant.  During  training,  the  emulator  NN  is  presented  with  a 
series  of  uniformly  distributed  random  inputs  and  corresponding  outputs  of  the  plant  (Figure  6). 
Using  the  error  between  the  output  of  the  network  and  the  actual  state  of  the  plant,  the  emulator’s 
network  weights  are  updated  using  a  standard  backpropagation  algorithm. 

Stage  two  of  the  process  is  training  the  controller  NN  (Figure  7).  First,  the  controller  ran¬ 
domly  drives  the  emulator  through  a  series  of  K  states.  For  each  input  from  the  controller,  the 
emulator  produces  the  appropriate  next  state  of  the  plant.  Eventually,  the  emulator  arrives  at  a 
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Figure  5.  Plant  and  Controller  (13:19) 


Figure  6.  Training  the  Neural  Net  Plant  Emulator  (13:19) 
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Figure  7.  TVaining  the  Controller  with  Backpropagation  (13:20) 

predetermined  stopping  point  (the  lifth  state).  It  is  at  this  point  where  the  emulator’s  final  state 
is  compared  to  the  desired  final  state  of  the  plant  (position  of  the  truck).  Since  there  is  no  way  to 
directly  compare  the  controller’s  output  to  the  final  state  of  the  plant,  the  state  error  must  back- 
propagate  through  the  emulator  network  in  order  to  obtain  the  equivalent  error  at  the  controller 
NN  output.  The  equivalent  error  can  then  be  backpropagated  through  the  controller  to  determine 
the  appropriate  weight  updates. 

During  this  process,  it  can  be  seen  that  the  backpropagation  through  the  emulator  produces 
two  error  vectors:  the  control  error  and  the  state  error.  That  is,  the  backpropagation  reveals  what 
control  input  should  have  been  given  and  also  what  state,  or  position,  was  required  to  produce  no 
error.  This  can  be  clearly  seen  when  assuming  the  control  input  and  state  input  to  the  emulator 
has  no  error.  Then  the  output  of  the  emulator  would  have  no  error  and  thus  must  be  equal  to  the 
desired  final  state.  In  essence,  the  error  in  the  prior  state  tells  what  state  the  emulator  should  have 
been  in  and  the  controller  error  tells  the  controller  what  it  should  have  done. 
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2.3  Analysis 


Up  to  this  point,  the  process  is  fairly  clear.  Unfortunately,  Nguyen  purposely  chose  not  to 
detail  the  error  backpropagation  through  the  emulator.  This  is  unfortunate  in  that  the  backprop- 
agation  algorithm  in  the  article  does  not  accurately  describe  the  process.  More  commonly  referred 
to  as  back  propagation  through  time  (BPTT)  (4,  8,  9,  15),  it  is  not  nearly  as  trivial  a  process 
as  Nguyen  implies.  In  particular,  Nguyen  does  not  detail  the  necessity  of  recording  the  output  of 
the  controller  net  at  each  time  step  during  the  training  process.  Without  this  information,  the 
backpropagation  algorithm  will  not  work. 

A  report  by  Michael  Lehr  contains  a  more  detmned  explanation  of  BPTT  (8).  This  report 
clearly  indicates  the  necessity  storing  the  control  output  and  hidden  node  outputs.  Not  only  are 
the  output  weights  required,  but  the  output  of  the  hidden  layers  must  be  available.  The  article 
mentions  that  the  storage  requirement  can  be  lowered  at  the  sacrifice  of  computations  using  the 
forward  propagation  algorithm  to  obtain  the  output  of  the  hidden  layer. 

If  we  examine  the  backpropagation  algorithm,  we  find  as  the  error  is  backpropagated  through 
each  layer,  the  effect  of  the  error  decreases  rapidly.  Since  BPTT  essentially  creates  a  neural  net 
with  nk  hidden  layers,  the  impact  of  the  error  quickly  becomes  insubstantial^.  The  problem  man¬ 
ifests  itself  as  a  degradation  of  the  error  signal.  As  it  backpropagates  through  layers  of  units  its 
magnitude  decreases;  thus,  the  units  far  from  the  output  receive  a  smadl  degraded  signal  amd  take 
correspondingly  longer  to  learn  than  those  closer  to  the  output  (15:18).  The  same  effect  occurs 
when  backpropagating  through  the  emulator  to  obtadn  the  control  equivalent  error.  The  amount 
of  chainge  to  the  controller  weights  will  become  almost  infinitesimail. 

Nguyen  mentions  the  tradning  method  used  involves  starting  close  to  the  dock  and  then 
gradually  moving  further  away.  Although  he  doesn’t  detail  why  he  chose  this  method,  it  does 
appear  to  be  necessary  when  considering  the  baickpropagation  algorithm  amd  the  error  propagation. 

is  the  number  of  layers  in  the  neural  net  and  k  is  the  number  of  time  steps. 
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By  starting  only  one  or  two  states  away  from  the  final  state,  the  final  error  has  a  much  greater 
impact  on  the  overall  weight  changes.  As  the  initial  state  is  moved  further  away,  the  weights  in  use 
are  much  closer  to  the  final  solution  than  those  that  would  have  been  produced  randomly.  This 
appears  to  be  a  necessity  when  using  BPTT.  If  he  had  started  training  at  a  greater  distance  from 
the  dock,  the  backpropagation  would  have  only  had  effect  in  the  final  two  states.  The  error  for 
states  prior  to  this  would  have  been  near  zero.  The  effect  would  have  been  to  greatly  increase  the 
training  time. 

Subsequent  correspondence  with  Derrick  Nguyen  (12)  also  revealed  the  details  of  backprop¬ 
agation  of  the  position  error.  When  backpropagating,  an  equivalent  error  for  the  position  vector 
is  obtained  from  both  the  emulator  and  controller  NNs.  The  question  was  which  error  is  used  for 
the  prior  state.  The  answer  is  both.  The  sum  of  both  equivalent  errors  is  fed  to  the  previous 
state.  Since  the  output  of  the  previous  state  is  connected  to  the  input  of  both  the  emulator  and 
the  controller,  the  error  at  the  output  of  a  node  is  the  weighted  sum  of  the  errors  of  all  the  nodes 
to  which  it  is  connected  in  the  next  layer.  In  this  case,  this  would  be  both  the  position  vector  in 
the  emulator  and  the  controller.  As  it  turns  out,  an  analysis  using  the  standard  backpropagation 
algorithms  would  lead  to  the  same  result.  The  key  is  recognizing  an  output  node  of  the  previous 
state’s  emulator  has  an  unweighted  connection  to  one  node  in  each  of  the  next  state’s  controller 
and  emulator  input  layers  (Figure  8). 

For  each  training  run,  the  weight  changes  for  eau:h  state  are  calculated  and  then  summed 
to  be  added  to  the  controller’s  weights.  However,  in  Nguyen’s  implementation,  the  controller’s 
weights  were  updated  as  the  changes  are  calculated.  This  would  seem  to  cause  problems  since  as 
the  error  backpropagates  through  each  stage,  the  original  weights  would  be  constantly  changing. 
But  Nguyen  points  out  that  the  changes  for  one  run  are  so  small  as  to  not  adversely  effect  the 
process.  It  is  the  accumulated  effect  over  a  large  number  of  runs  that  improves  the  controller’s 
performance. 
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Error  Propagation 


Figure  8.  Equivalent  Error  Propagation.  As  the  final  position  error  backpropagates  through  time, 
the  error  presented  to  the  controller  (£„)  in  state  k  is  the  equivalent  error  at  the  control 
input  to  the  emulator  in  state  k.  The  error  at  the  emulator  in  the  previous  state  (k- 
1)  is  the  sum  of  the  position  equivalent  errors  from  the  controller  (Stc)  and  from  the 
emulator  (^ae)  in  state  k. 
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Care  should  be  exercised  with  this  procedure.  It  is  possible  for  the  network  to  lock  in  a  partial 
solution.  The  net  could  be  moving  to  a  position  in  weight  space  where  the  error  signals  become 
so  small  as  to  make  further  movement  impractical.  This  may  be  a  feature  of  updating  the  weights 
after  every  example  (15:18). 

Backpropagation 

Nguyen’s  application  uses  the  Adaline  (22)  model  for  development  of  the  neural  networks. 
Neural  Graphics  and  other  AFIT  applications  use  a  slightly  different  model.  The  primary  difference 
in  the  Nguyen  application  is  that  the  Adaline  uses  the  nonlinear  function  /(a)  =  tanh{a)  where 
standard  backprop  uses  the  sigmoid  function  /(a)  =  1/(1  +  e~"). 

The  use  of  a  sigmoid  function  should  have  little  impact  on  the  performance  of  the  net,  although 
some  researchers  attest  that  the  hyperbolic  tangent  function  might  converge  more  quickly  since  the 
output  range  is  -1  to  +1,  where  the  sigmoid  ranges  from  0  to  +1. 

2.5  Summary 

The  need  to  meet  demanding  control  requirements  in  increasingly  complex  dynamical  control 
systems  under  significant  uncertainties  makes  neural  networks  very  attractive.  Their  ability  to 
learn,  to  approximate  functions,  to  classify  patterns,  and  their  potential  for  massively  parallel 
hardware  implementation  are  the  key  characteristics.  (1:8) 

The  Nguyen  approach  to  developing  a  NN-based  controller  is  the  most  appropriate  for  a 
flight  control  system.  The  emulator  NN  will  fully  parameterize  the  helicopter,  negating  the  need 
for  precise  control  data. 

This  method  also  presents  implications  to  the  development  of  simulator  systems.  The  emu¬ 
lator  completely  parameterizes  the  plant  without  using  mathematical  derivations.  A  simulation  of 
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the  device  is  possible  since  a  complete  I/O  mapping  is  produced.  Control  inputs  to  an  emulator 
NN  will  produce  an  accurate  representation  of  the  plant  response. 

While  the  trmning  process  may  at  first  appear  to  be  complex  and  time  consuming,  the  final 
controller  will  consist  of  only  a  single  multilayer  NN.  Lending  itself  to  parallel  hardware  implemen¬ 
tation,  such  as  ETANN,  the  NN-based  controller  can  react  much  faster  than  a  conventional  control 
system. 
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III.  Methodology 


5.1  Introduction 

As  mentioned  in  Chapter  II,  the  Nguyen  emulator /controller  approach  to  developing  a  NN- 
based  controller  will  be  used  in  this  research.  However,  prior  to  any  attempt  at  developing  the 
controller,  an  accurate  emulator  NN  must  be  created.  The  development  of  the  helicopter  emulator 
will  be  approached  in  a  two-stage  process.  The  initial  development  of  an  emulator  will  focus  only 
on  the  tail  rotor  of  the  helicopter.  Using  this  simpler  problem,  the  neural  network  design  and 
training  process  can  be  refined  prior  to  attempting  the  more  complicated  task  of  emulating  the 
entire  helicopter  in  the  second  step. 

5.2  Stage  One  •  Tail  Rotor 

The  development  of  the  emulator  for  the  tail  rotor  is  approached  in  a  similar  fashion  to 
Nguyen’s  truck  backer-upper.  Since  the  FAME  apparatus  is  capable  of  recording  both  input  control 
and  output  position  information,  it  is  possible  to  record  changes  in  the  yaw  position  as  the  tail 
rotor  control  inputs  are  manipulated.  Using  this  data,  the  emulator  can  be  trained. 

Initially,  this  approach  included  the  use  of  PC  Neural  Graphics  as  the  NN  design  and  im¬ 
plementation  software.  It  was  later  determined  MATLAB®  would  be  a  more  suitable  design  and 
experimentation  tool.  MATLAB®  is  especially  efficient  at  processing  vector  and  matrix  informa¬ 
tion.  The  backpropagation  equations  (16)  were  easily  converted  into  vector  and  matrix  format  (see 
Appendix  C). 

3.2.1  Emulator  Development.  The  first  attempt  at  development  of  a  NN  control  system 
focuses  only  on  the  tail  rotor  control  surface.  Examination  of  a  single  control  surface  reduces  the 
number  of  input  and  output  parameters,  thereby  reducing  the  size  and  complexity  of  the  network. 
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Figure  9.  Tail  Rotor  Position.  The  tail  rotor  portion  (0)  depends  on  the  force,  or  thrust,  exerted 
by  the  tail  rotor.  The  thrust  is  a  function  of  the  tail  rotor  blade  pitch,  or  rudder  (r) 
and  the  throttle  setting  (t). 

The  emulator  NN  is  designed  to  map  the  input  functions  of  state  and  control  vectors  to  the 
output  state  vector.  In  this  case,  it  was  obvious  the  control  vector  would  consist  of  at  least  the 
throttle  setting  and  tail  rotor  pitch,  represented  by  the  variables  t  and  r.  These  two  inputs  control 
the  movement  of  the  tail  empanage  (Figure  9). 

The  first  step  is  to  record  data  from  the  FAME  apparatus.  In  order  to  isolate  the  tail  rotor 
and  reduce  effects  of  motor  torque,  the  main  rotor  is  disabie.  This  is  accomplished  by  removing 
the  gear  from  the  main  rotor  shaft.  Also,  the  training  stand  is  adjusted  so  that  movement  about 
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the  pitch  and  roll  axes  is  eliminated.  Only  yaw  movement  is  permitted  during  this  phase.  Then, 
using  the  FAME  joystick  control,  the  helicopter  U  maneuvered  manually  through  the  entire  range 
of  throttle  and  rudder  controk  while  measuring  the  yaw  response. 

The  recorded  data  is  normalized  prior  to  tndning  the  network.  The  input  and  output  data 
for  training  the  emulator  is  normalized  between  0  and  1.  Since  the  FAME  apparatus  reports  the 
various  position  and  control  information  using  an  8-bit  binary  number,  the  data  u  normalized  by 
simply  dividing  the  recorded  flight  data  by  255  (2*  -  1). 

It  is  necessary  to  determine  the  type  of  input  and  output  data  used  in  developing  the  con¬ 
troller.  Along  with  the  control  inputs,  the  FAME  system  records  the  tail  position  or  yaw  angle 
with  respect  to  time.  With  this  timing  information,  it  is  also  possible  to  derive  the  angular  velocity 
and  acceleration  of  the  tail  section.  Although  off-line  calculation  of  these  derivatives  is  possible, 
time  delayed  input  samples  should  also  provide  similar  results. 

The  initial  set  of  input  vectors  selected  included  the  throttle,  tail  rotor  pitch,  present  yaw  posi¬ 
tion,  and  the  prior  two  yaw  positions.  This  is  represented  in  vector  format  as  (t,  r,  0^,  0k_i,  0k-2]^. 
Other  input  vector  sets  include  the  use  of  velocity  and  acceleration  and  also  four  and  five  position 
delay.  These  configurations  will  be  referred  to  as  the  three-state,  v-a,  four-state  and  five-state 
models  respectively. 

S.2.2  NN  Prototype.  After  recording,  the  data  is  transferred  to  a  UNIX-based  system 
(Sparc  Station)  and  the  emulator  NN  is  prototyped  using  MATLAB®.  Since  MATLAB®  is  de¬ 
signed  to  process  vector  and  matrix  data,  the  backpropagation  algorithms  have  been  modified.  The 
vectors  x  (m  x  1),  a  (n  x  1),  s  (p  x  l),and  d  (p  x  1)  are  the  input,  hidden  layer  output,  actual 
output,  and  desired  output  vectors,  respectively.  The  matrices  Wi  (n  x  (m+1))  and  Wo  (p  x 
(n-fl))  are  the  output  and  input  weight  matrices.  The  additional  column  in  each  weight  matrices 
is  due  to  the  bias  term  which  is  appended  to  the  input  and  hidden  layer  vectors. 
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Several  different  NN  configurationa  are  tested.  The  basic  configuration  consists  of  a  sin^ 
hidden  layer  using  a  sigmoid  function  and  a  linear  input  and  output  layer  (linear-sigmoid-linear) 
(Figure  10). 


a 


Emulator 

Figure  10.  Linear-Sigmoid-Linear  NN 


The  forward  and  backpropagation  equations  used  are  given  below.  A  complete  derivation  can 
be  found  in  Appendix  C.  The  input  vector  is  represented  by  x,  the  output  vector  by  i,  the  hidden 
layer  output  by  a  and  the  desired  output  d.  The  equations  for  forward  propagation  through  the 
network  are 


W„a 

(1) 

where  a  = 

(2) 

and  a  =  /i»(W<x) 

(3) 

(4) 
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In  this  case,  the  vector  valued  function  /hCsi)  represents  an  elementwise  operation  on  the 


n  X  1  vector  a  defined  as 


/h(a)  =  [(1  +  (1  +  ,  (1  +  (5) 

The  weight  update  equations  used  for  backpropagation  are 


Wt 


=  w;-q 


dE 


where 


aw, 

dE 


=  Wr-q 


awo 
dE 


—  =  -(d  -  *)a 


iT 


awr 


where  =  -[diag{&Q{l  -  a))|Q„]W;^(d  -  s)x’’ 


and  O  is  the  Hadamard,  or  array,  product 


(6) 

(7) 

(8) 

(9) 

(10) 


The  training  process  will  iterate  through  the  forward  propagation  and  weight  update  equa^ 
tions,  comparing  the  output  of  the  network  for  each  input  control  and  state  vector  to  the  actual 
next  state  of  the  system.  The  error  is  used  in  the  backpropagation  equations  to  update  the  network 
weights. 


S.2.2.1  Testing.  To  test  the  emulator  NN,  exemplars  of  the  tail  rotor  state,  or 
position,  that  have  not  been  presented  during  training  are  fed  through  the  forward  propagation 
network.  The  output  of  the  NN  is  then  compared  to  the  actual  response  of  the  tail  rotor  to  the 
control  inputs. 

S.2.S  Controller  Development.  Continuing  with  the  Nguyen  approach,  the  output  of  the 
controller  net  is  fed  to  the  emulator  along  with  the  state  information.  The  output  of  the  emulator 
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net  is  then  compared  to  the  desired  final  state  of  the  plant.  The  error  is  backpropagated  through 
the  emulator  net  and  produces  an  equivalent  error  at  the  input  to  the  emulator  net,  which  is  also  the 
output  of  the  controller  net.  This  equivalent  error  is  then  backpropagated  through  the  controller 
net  and  the  controller  weights  are  updated. 

In  this  case,  the  problem  should  be  simpler  than  the  truck  backer  upper.  Unlike  the  truck, 
at  each  state  in  the  tail  rotor  problem  the  desired  state  is  always  the  same.  At  each  state,  the 
controUer  will  always  attempt  to  minimize  the  angular  error.  In  the  truck  backer  upper,  back 
propagation  through  time  (BPTT)  is  necessary  since  there  is  no  direct  path  from  a  particular  state 
to  the  final  desired  state.  In  order  to  minimize  the  final  error,  the  truck  might  initially  have  to 
move  in  a  direction  away  from  the  dock.  In  the  tail  rotor,  each  state  has  a  direct  path  to  the 
final  state.  At  any  instance,  the  controller  would  seek  to  minimize  the  angular  offset  from  the  final 
desired  position.  This  removes  the  need  for  BPTT. 

Nguyen  also  used  the  actual  plant  dynamics  in  the  controller  training  process.  This  was 
possible  since  the  pl^ult  used  was  a  simulation,  not  an  actual  tractor-trmler.  At  each  time  step 
during  forward  propagation,  the  output  of  the  controUer  was  fed  to  both  the  emulator  and  the 
truck  simulator,  producing  both  and  estimated  and  an  actual  next  state.  The  actual  next  state  is 
then  presented  to  the  controUer.  The  estimate  is  not  used  untU  the  final  state.  Thus,  at  each  time 
step,  the  controUer  has  an  accurate  representation  of  the  plant’s  state.  In  this  research,  and  in  the 
real  world,  the  plant  dynamic  wiU  not  always  be  available  in  mathematical  form.  The  question 
remains  whether  this  process  wiU  work  for  a  real  plant,  without  using  a  mathematical  representation 
of  its  dynamics. 

During  the  controUer  training  process,  a  random  present  position  vector  is  input  to  the 
controUer.  This  in  turn  produces  some  random  control  vector.  The  control  vector  along  with 
the  present  position  vector  is  input  to  the  emulator.  The  emulator  NN  then  produces  the  next 
position  of  the  plant.  The  error  between  this  next  state  and  the  desired  final  state  of  the  plant  is 
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backpropagated  through  the  emulator  to  obtain  the  equivalent  control  and  position  errors  at  the 
input  layer.  The  control  equivalent  error  is  backpropagated  through  the  controller  NN  to  update 
the  network  weights.  In  BPTT,  the  position  equivalent  error  at  the  emulator  input  and  the  position 
equivalent  error  at  the  controller  input  would  be  summed  to  obtain  the  equivalent  error  for  the 
previous  state. 

This  process  will  continue  until  the  error  is  reduced  to  an  acceptable  level.  This  level  must 
be  determined  dxperimentally  since,  in  most  cases,  the  angular  error  cannot  be  reduced  to  zero  in  a 
single  time  step.  However,  the  marginal  error,  or  changes  between  sequential  error  measurements, 
should  approach  zero  as  the  controller  network  becomes  fully  trained. 

Testing  the  controller  consists  of  presenting  a  random  initial  position  to  the  controller  NN 
and  then  observing  the  output  of  the  emulator  NN.  If  adequately  trained,  the  controller  NN  should 
drive  the  emulator  NN  to  the  desired  final  position. 

3.3  Stage  Two  -  Helicopter  Emvdator 

Development  of  the  emulator  for  the  remaining  control  and  state  inputs  will  be  essentially 
the  same  as  the  tail  rotor  development.  Again,  the  flight  data  recorded  from  the  FAME  apparatus 
is  used  to  train  the  helicopter  emulator.  Exemplars  now  include  all  position  information  (pitch  (^), 
roll  (p),  yaw  {$),  x-coordinate,  y-coordinate,  altitude  (z))  (Figure  11)  and  the  all  control  inputs 
(throttle,  rudder,  aileron,  collective,  cyclic)  (Figure  12). 

3-4  Cmtroller  Implementation  on  Actual  Helicopter 

Once  the  NN  controller  has  been  fully  developed  and  tested,  the  next  step  is  controlling 
the  actual  plant.  FAME  makes  this  fairly  straightforward.  Minor  changes  to  the  FAMEPC  O 
code  (Appendix  A)  used  in  FAME  should  allow  incorporation  of  the  NN  controller.  A  forward 
propagation  routine  would  replace  the  manual  control  function  “SetServoFromStick().” 


28 


Ii^aim  Jiitpii  I IM  .J I.kipi^ji  .i|^^i;-..ji(gjiiMiw.  1^  „i|iiii.4)iii^!^<,i  I*.#,  -  iHU'y  .1;.  ■  w.  ww 


Figure  11.  Helicopter  Attitude  and  Position 

S.5  Summary 

The  method  of  controller  development  devised  by  Nguyen  can  be  directly  applied  to  this 
particular  control  problem.  The  first  and  most  important  step  is  to  train  and  test  the  emulator 
NN.  The  primary  differences  in  the  approach  outlined  here  include  the  lack  of  necessity  of  BPTT 
and  the  lack  of  the  plant  dynamics  for  comparison  during  controller  training. 

By  first  decomposing  the  overall  helicopter  problem  into  a  tail  rotor  emulator  and  control 
effort,  the  basic  approach  can  be  tested  prior  to  attempting  the  more  complicated  task  of  emulating 
and  eventually  controlling  the  entire  aircraft. 


29 


Traiwntttar  slick  movamsnls 


Resultant  helicopter  movement 


Please  note  that  this  is  only  a  guide  to  control  functions  and  is  not  a  training  procedure 


Figure  12.  Transmitter  Layout  and  Control  %nction  (7:40) 
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IV.  Results 


This  chapter  details  the  results  of  the  experimentation  outlined  in  Chapter  III,  documenting 
the  development  of  the  emulator  NN  for  the  tail  rotor  and  the  helicopter  through  the  use  of  the 
Nguyen  method.  This  chapter  will  also  discuss  some  preliminary  work  done  in  the  development  of 
the  controller  NN  for  the  tail  rotor. 

4.1  Emulator 

The  emulator  development  of  the  tail  rotor  proved  to  be  fairly  straightforward.  The  various 
neural  network  models  were  prototyped  and  tested,  varying  the  design  parameters  of  each,  such  as 
number  of  hidden  nodes,  step  size,  and  number  of  epochs.  All  resulted  in  accurate  emulators  of  the 
tail  rotor.  The  helicopter  emulator  was  developed  using  the  three-state  model  prototyped  with  the 
tadl  rotor.  The  results  were  equally  as  promising. 

The  emulator  development  consists  of  a  two-phase  process.  Phase  I  concentrates  only  on 
the  tail  section,  limiting  movement  to  yaw  (angular  offset)  only.  Phase  II  then  models  the  entire 
helicopter  in  a  neural  network. 

4.1.1  Phase  I.  The  primary  step  in  developing  a  NN-based  controller  is  to  first  design 
and  test  an  emulator  NN.  In  order  to  simplify  the  problem  initially,  this  first  attempt  will  only 
examine  the  tail  section  of  the  helicopter.  This  reduces  the  complexity  ^md  quantity  of  the  input 
and  output  variables. 

Using  the  FAME  apparatus,  937  time  samples  of  tail  rotor  performance  were  recorded  for 
training  and  testing  the  emulator  NN.  Of  these,  the  first  300  were  used  as  training  exemplars  with 
the  remaining  to  serve  as  the  test  exemplars. 

Various  input  and  output  parameters  were  tested  to  obtain  the  best  emulation  of  the  tail 
rotor.  The  first  configuration  uses  a  three-state  input  vector,  with  the  present  and  past  two  yaw 
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positions  as  inputs  and  the  next  yaw  position  as  the  output.  Also  tested  were  four  and  five-state 
configurations,  using  the  present  yaw  position  along  with  the  past  three  and  four  yaw  positions. 
The  last  configuration  tested  uses  the  yaw  position,  velocity  and  acceleration  as  input  vector  and 
the  next  yaw  position,  velocity  and  acceleration  as  the  output  vector.  These  different  configurations 
were  tested,  varying  the  number  of  hidden  nodes,  step  size  (t)),  and  number  of  epochs. 

4-1-2  Testing.  In  three-state  configurations,  the  input  vector  to  the  net  included  the 
control  vector  (throttle  and  rudder)  and  the  state  vector  (current  and  past  two  yaw  positions), 
represented  as  x  =  [ujlsj]*’  =  [t,  r|  O/,,  Ok-i,  The  desired  output  of  the  net  is  the  next 

yaw  position  (^t+i)  (Figure  13). 
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Figure  13.  Emulator  Neural  Network 
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Using  MATLAB®  to  prototype  the  NN  and  to  run  the  backpropagation  routine,  the  emulator 
turned  out  to  be  surprisingly  accurate.  After  10000  epochs  over  a  training  set  of  300  exemplars, 
the  emulator  NN  was  tested  over  the  entire  data  set  of  900  exemplars.  The  NN  tracked  the  output 
with  amazing  accuracy,  considering  over  600  of  the  exemplars  were  never  presented  for  training. 
The  final  configuration  used  was  a  two-layer  network  with  fifteen  hidden  nodes.  The  output  of  the 
network  over  the  test  set  is  shown  in  Figure  14. 


Yaw  Response 


Figure  14.  Tail  Rotor  Emulator  Performance 

This  result  in  itself  is  remarkable.  It  shows  a  real,  physical  plant  can  be  accurately  modeled 
through  use  of  a  NN.  Prior  effort  in  developing  emulator  NNs  used  mathematical  modek  of  the 
plant.  In  this  case,  the  actual  plant  was  used  to  trsdn  the  network. 

The  four  and  five-state  configurations  were  also  trained  and  tested  in  a  similar  manner.  The 
assumption  was  more  information  about  the  past  performance  should  produce  a  more  accurate 
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emulator.  However,  both  of  these  configurations  produced  results  very  similar  to  the  three-state 
configuration. 

The  emulator  model  using  angular  position,  velocity,  and  acceleration  was  ako  prototyped 
and  tested.  Initially,  the  results  of  the  velocity  and  acceleration  model  (v-a)  appeared  to  indicate 
it  was  a  better  predictor.  The  yaw  position  was  much  more  accurate  that  any  of  the  delayed  state 
models.  (Figure  15). 


Figure  15.  Tail  Rotor  Emulator  NN  Performance  (Velocity-Acceleration  Model) 


When  compared  to  the  yaw  position  error  of  the  three  state  configuration,  the  v-a  model 
appear  to  have  better  performance  at  predicting  the  next  yaw  position  (Figure  16).  The  mean 
square  error  is  defined  as  in  the  backpropagation  equations,  i.e.  |||b/d  —  h/zHI- 
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Figure  16.  Comparison  of  position  error  of  the  three-state  and  velocity-acceleration  models  of  the 
tail  rotor  emulator  NN 


At  first  it  would  appear  the  velocity-acceleration  model  performed  much  better  than  the 
three-state  delay  model.  The  next  yaw  position  error  is  much  lower  for  the  velocity  acceleration 
model.  However,  the  next  state  vector  of  the  v-a  model  consists  not  only  of  the  yaw  position,  but 
also  the  velocity  and  acceleration  at  that  point.  When  summed,  the  entire  error  is  approximately 
the  same  as  the  three-state  model  (Figure  17). 


Figure  17.  Comparison  of  the  total  error  of  the  three-state  and  velocity-acceleration  models  of 
the  tail  rotor  emulator  NN 
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4.1.S  Phase  II.  The  remainder  of  the  helicopter  control  surfaces  (aileron,  cyclic,  elevator) 
and  spatial  responses  (pitch,  roll,  X-Y  coordinates,  altitude)  are  included  in  the  plant  emulator. 
Using  the  three-state  delay  configuration  for  the  emulator.  Again,  the  number  of  hidden  nodes  and 
step  size  were  varied  during  testing. 

Again,  using  the  flight  data  recorded  from  the  FAME  apparatus,  the  exemplar  set  consists 
of  a  500  sample  segment  from  one  set  of  data.  The  test  set  was  1131  data  points  from  an  entirely 
different  flight. 

The  emulator  results  for  the  helicopter  were  equally  as  promising  as  the  tail  rotor  (Figure  18). 
Most  of  the  error  appears  to  be  concentrated  primarily  in  the  first  and  last  one  hundred  or  so  samples 
of  the  test  set  (Figures  19  &  20).  Since  the  helicopter  is  actually  flying  only  during  the  middle 
portion  of  the  test  set,  apparently  the  takeoff  and  landing  performance  is  not  fully  parameterized 
in  the  NN. 

4.2  Controller  Results 

Development  of  the  controller  proved  to  be  more  problematic.  After  developing  the  necessary 
MATLAB®  program,  the  emulator  was  used  to  train  the  controller  using  the  Nguyen  method. 

Initially,  it  appeared  as  if  the  controller  was  successfully  trained.  The  error  converged  to 
an  acceptably  low  level.  However,  subsequent  test  proved  the  tail  rotor  controller  converged  to  a 
solution  outside  the  range  of  the  emulator  input.  Although  the  input  data  used  for  training  the 
emulator  was  normalized,  there  was  no  way  to  insure  the  control  output  from  the  controller  would 
be  in  the  normalized  range.  Apparently,  the  controller  found  a  solution  outside  the  range  of  the 
emulator  input  values. 

Thought  was  given  to  implementing  a  hard  limiting  function  at  the  output  of  the  controller, 
but  this  would  not  allow  backpropagation  due  to  the  inability  to  differentiate  this  function.  Another 
option  was  to  include  a  sigmoid  function  at  the  output  to  the  controller.  However,  it  was  felt  this 
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Figure  19.  Helicopter  Emulator  NN  Error 
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ToMEiror 


Figure  20.  Helicopter  Emulator  NN  Total  Error 

would  substantially  reduce  the  impact  of  error  as  it  backpropagated  through  the  system,  thereby 
increasing  training  time  and  reducing  accuracy. 

Another  possible  solution  was  considered,  but  not  investigated.  If  the  control  energy  was 
included  in  the  error  vector,  this  would  essentially  ensure  the  control  output  would  remain  in  an 
acceptable  range  for  the  emulator  input.  As  the  control  energy  increased,  the  error  would  also 
increase.  Nguyen  discusses  this  point  and  indicates  it  can  be  easily  added  incorporated  into  the 
backpropagation  algorithm  by  adding  the  term  -auk  to  the  equivalent  error  (13:481).  In  this 
instance,  Uk  represents  the  control  input  at  time  k  and  a  is  scalar  weighting  factor. 

4-S  Results 

Artificial  neural  networks  are  capable  of  emulating  d3mamic  non-linear  plants  with  a  high 
degree  of  accuracy.  Both  the  tail  rotor  and  the  more  complex  component  of  the  helicopter  were 
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reproduced  by  the  NN.  This  is  a  crucial  step  in  the  development  of  a  NN-based  controller.  These 
results  also  lead  to  the  possible  application  of  NNs  to  simulator  development.  The  emulator  NN 
eliminates  the  need  to  develop  complex  mathematical  representations  of  the  plant  in  order  to 
simulate  the  plant.  It  only  requires  a  sufficient  type  and  quantity  of  examples  of  the  plant’s 
behavior. 
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V.  Conclusions  and  Recommendations 


5.1  Concluaioru 

The  research  conducted  in  the  course  of  this  thesis  investigated  the  application  of  Nguyen  self¬ 
learning  neural  network  for  control  to  the  specific  problem  of  controlling  a  scale-model  helicopter. 
A  critical  requirement  for  the  development  of  a  control  system  is  the  successful  emulation  of  the 
plant  in  a  NN.  This  process  involves  the  correct  selection  of  input/output  parameters  necessary  to 
correctly  parameterize  the  plant. 

Application  of  the  method  developed  by  Nguyen  and  Widrow  was  not  applied  to  a  real  plant. 
By  using  simulation,  the  mathematical  characterization  of  the  plant  was  available  when  training  the 
controller  NN.  The  application  of  this  method  to  a  real  plant  does  not  permit  the  use  of  the  plant 
dynamics  when  training  the  controller.  Instead,  the  emulator  NN  alone  must  fully  characterize  the 
plant  to  be  controlled. 

5.2  AccomplishtnenU 

In  this  research,  the  following  objectives  have  been  successfully  accomplished: 

•  It  is  possible  for  a  neural  network  to  accurately  replicate  the  input-output  mapping  of  a  com¬ 
plex,  nonlinear  real  plant.  The  emulator  NN  replicated  the  performance  of  the  tail  rotor  and 
helicopter  with  a  high  degree  of  accuracy.  This  was  accomplished  without  the  development 
of  mathematical  models  of  the  plant.  The  emulator  is  dependent  only  on  the  size  of  the  net 
and  training  time.  This  ability  to  emulate  a  real  plant  has  application  not  only  to  control 
problems  but  could  also  have  application  to  simulator  development. 

•  The  application  of  neural  networks  to  the  control  of  a  dynamic,  nonlinear  real  plant  has 
been  investigated.  Most  previous  efforts  in  NN-based  control  focused  primarily  on  computer 
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simulations  of  aircraft  and  other  devices.  The  use  of  a  real  plant,  although  scale,  is  one  step 
in  the  direction  of  application  to  full  scale  flight  control. 

•  The  Nguyen  technique  was  applied  to  a  problem  involving  a  real  plant.  This  method  involves 
the  use  of  two  NNs  and  backpropagation  through  time  (BPTT).  The  many  vagarira  in  this 
article,  including  the  memory  intensive  nature  of  BPTT,  were  clarified  and  documented. 

•  The  Fast  Adaptive  Maneuvering  Experiment  apparatus  was  further  developed  and  refined, 
thereby  reducing  the  workload  and  flying  expertise  required  by  an  experimenter.  This  refine¬ 
ment  included  numerous  hardware  and  software  modifications  and  development  of  documen¬ 
tation. 

•  MATLAB®  proved  to  be  a  useful  tool  in  NN  research.  All  the  equations  derived  in  this 
research  were  implemented  in  MATLAB®.  Its  ability  to  handle  vector  and  matrix  represen¬ 
tations  permits  rapid  prototjrping  of  NNs.  The  interpretive  language  allowed  modifications 
to  be  quickly  and  easily  implemented. 

5.3  Recommendations 

5.3.1  Controls  Research.  There  remains  a  great  deal  of  research  remaining  in  the  area 
of  neural  networks  for  controls.  In  general,  investigation  into  the  control  systems  using  neural 
networks  should  continue.  Specifically,  research  should  continue  to  investigate  Nguyen’s  approach 
of  developing  a  controller  neural  network.  This  should  include  a  duplication  of  his  experiments, 
using  both  a  computer  simulation  and  an  operational,  scale-model  tractor-trailer. 

5.3.2  FAME.  The  Fast  Adaptive  M^uleuvering  Experiment  is  an  excellent  vehicle  in  the 
investigation  of  control  application  to  real  plants.  This  system  permits  the  direct  application  of 
the  plant  dynamics  rather  relying  on  mathematical  equations  to  model  the  system.  Upgrades  in 
the  software  and  hardware  of  the  FAME  apparatus  are  continuously  developed.  GMU  is  currently 
developing  a  firee-flying  version  of  FAME.  Also,  advancing  technology  in  R/C  flying  is  creating 
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the  opportunity  for  more  accurate  measurement  of  flight  dynamics.  The  latest  breakthrough  is  a 
solid-state  gyro  system  which  is  more  precise  by  orders  of  magnitude  than  the  present  mechanical 
versions. 

5.3.S  Simulators.  This  research  has  also  uncovered  the  possible  application  of  NNs  to 
simulator  development.  The  development  of  an  emulator  proves  a  complex,  nonlinear  plant  can  be 
represented  in  a  NN.  With  this  input-output  mapping,  it  should  be  relatively  straightforward  task 
to  develop  a  simulator  based  on  a  neural  network. 
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Appendix  A.  Software,  FAMEPC  Version  6.0 


Minor  changes  to  version  6.0  of  the  software  included  changing  the  directory  paths  of  the 
header  files  “pcdef.h”  and  “famedef.h” .  A  small  section  of  code  was  changed  to  select  of  COM  1 
instead  of  COM  2  as  the  communications  port  interface  to  the  MCU.  Finally,  the  menu  display  was 
changed  to  refiect  the  correct  software  version  and  to  correct  a  spelling  error. 

It  is  not  mentioned  in  any  of  the  FAME  documentation,  but  it  is  also  necessary  to  include  a 
file  called  “generic.cal”  in  the  same  directory  as  FAMEPC.EXE.  The  program  will  run  without  it, 
but  it  will  not  report  the  state  variables. 

A  change  was  made  in  the  timing  function  “DelayUntil()”  in  “ControlLoopI).”  This  function 
caused  intermittent  program  lockup  while  attempting  manually  control  the  FAME  helicopter.  This 
function  was  replaced  with  the  C-standard  function  “delay(lO)”,  which  produces  a  time  delay  of 
10  milliseconds.  Unfortunately,  this  causes  inaccurate  timing  data  to  be  recorded  in  “filel.trn.” 
However,  the  data  points  are  still  recorded  at  even  intervals  of  approximately  25  milliseconds. 
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Z******************************* ««*«««««««**«**«**«***«**«««**«*«*****«*«****/ 


/*  File  Name:  FiMEpc.C  */ 
/*  */ 
I*  Authors:  Darrell  Duane,  Steve  Suddarth  and  G-Z  Sim  *! 
/*  Update  History:  Version  6.0,  November  20,  1992  */ 
I*  Modified  October  12,  1993  by  Ronald  E.  Setzer  */ 
/•  •/ 
/*  indicates  functions  and  their  protot3rpes  •/ 
f*  —  indicates  ISRs  */ 
/♦  */ 


finclude  <stdio.h> 

#include  <stdlib.h> 
iinclude  <dos.h> 

#include  <conio.h> 

#include  <float.h> 

#include  <ctype.h> 
iinclude  <bios.h> 

#include  <math.h> 

#include  "j:\vorkfile\borlandc\famedef.h"  /efile  path  to  heaider  files*/ 
#include  "j :\vorkfile\borlandc\pcdef .h" 


/*  BEGIN  PROGRAM:  BEGIN  INITIALIZATION  FUNCTIONS  •/ 

/*  Initializes  ISR  for  TX  A  RX  over  serial  port  of  PC  */ 

void  initializelSRCvoid) 

{ 

oldseri2Q.int  =  getvect(SERIALINT) ;  /*  save  the  old  ISR  address  */ 

setvect(SERIALINT,nevseriadint) ;  /*  attach  the  new  ISR  to  the  vector  */ 

outportb(MODEMCTL,<inportb(MODEMCTL)  A  OxEF  I  DTR  |  RTS  I  0DT2)): 

outportb(PIC01,  (inportb(PICOl)  A  SERIALIRQ));  /*  enable  the  8259  inter  */ 

outportbCPICOO ,E0I) ; 

inportb(RXDATA) ; 

inportb(INTIDENT) ; 

inportb(LINESTATUS) ; 

inport (MODEMSTATUS) ; 

/♦  printfC  Serial  port  initialized. \n") ;  */ 

> 

/*  Restore  the  old  ISR  attached  to  the  com  that  ve  have  used  */ 
void  RestoreOldlSR(void) 

setvect(SERIALINT,oldserialint) ; 
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printf ("Old  ISR  restored  \n"}: 

> 

/eeeeeeee*****************************************************************/ 

/*  Function  to  initialize  the  UART,  attach  the  neu  ISR,  save  the  old  ISR  */ 
/e************************************************************************/ 

void  InitSerialPort (void) 

{ 

initserial.serial_initial_bits.parit3r=  PARITY«2  ?  3  :  PARITY  ; 
initserial . seriitl.initial.bits . stopbits=  STOPBITS-1 ; 
initserial . serial.initial.bits .vordlen-  WOROLEN-5 ; 
initserial . serial.initial.bits .brk  =0 ; 
initserial . serial.initial.bits .divlatch  =1 ; 
outportb(LINECTL , initserial . serial.initial.char) ; 
outportb(DIVLSB,(char)  ((115200L/BiaD)  A  255)); 
outportb(DIVMSB,(char)  ((115200L/BAaD)  »  8)); 
initserial. serial.initial.bits. divlatch  =  0; 
outportb(LINECTL , initserial . seried.initial.char) ; 
initieilizelSRO ; 

} 

I*  Initialized  flags  and  semaphores  for  receiving  data  from  ECU  e/ 

/«**««*«»««**«**4i*««*««««««««««««*«««««4i****4i**«««*«V«*V***V»****««*4i»****««/ 

void  InitRXparm(void) 

{ 

RXstream=FALSE ; 

RXindex=0 ; 

outportb(LINECTL , (inportb(LINECTL) I 0x80) ) ; 

/*  printf ("DLAB  bit  in  LCR  is  set  =  1");  */ 

/♦  printf  ("LCR  =  0x'/,x\n"  ,inportb(LINECTL)) ;  */  /*  Line  Control  Register  */ 

/*  printf ("BAUDO  =  0x%x  ",inportb(DIVLSB)) ;  */ 

/*  printf ("BAUDl  =  0x%x  " ,inportb(DIVMSB)) ;  */ 
outportb(LINECTL, (inportb(LINECTL)A0x7f )) ; 

/*  printf ("DLAB  bit  in  LCR  is  set  =0  ");  */ 

/*  printf ("DATA  =  0xXx\n",  inportb(RXDATA}) ;  */  /*  Receive  data  vztlue  */ 

/*  printf  ("LCR  =  0x*/,x\n",  inportb(LINECTL)) ;  */  /*  Line  Control  Register  */ 
/*  printf ("HCR  =  0x%x\n",  inportb(MODEMCTL)} ;  *!  /*  Modem  Control  Register  */ 
/*  printf ("lER  =  0x%x\n",  inportb(INTENABLE)) ;  */  /*  Interrupt  Enable 

Register  */ 

/*  printf ("LSR  =  0x%x\n",  inportb(LINESTATUS)) ;  */  /*  Line  Status 

Register  */ 

/*  printfC'MSR  «  0x%x\n",  inportb(HODEMSTATUS)) ;  */  /*  Modem  Status 

Register  Vedues  */ 

/*  printf ("IID  =  0x%x\n",  inportbdiniDENT)) ;  */  /*  Interrupt  Identification 

A  Causes  */ 

Zero.Xcord  -  0; 

Zero.Ycord  =  0; 
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Zsro.Zcord  «  0; 

Zero. Pitch  a  O; 

Z«ro.Roll  s  0; 

Zaro.Yav  *  0; 

Zero. Gyro  »  0; 

}  /*  end  intitalization  of  RX  parameters  */ 

/*  END  INITIALIZATION  SECTION:  BEGIN  ISR  S  */ 


/* - */ 

/*  New  communication  interrupt  service  routine  */ 

/* - */ 


static  void  interrupt  far  nevserialint(void) 
{  char  identreg; 

identreg=inportb(INTIDENT) ; 
switch  (identreg) 

case  4: 

PC_RX_ISR(); 
break; 
case  2: 

printfC'TX  ISR"); 
break; 
default : 

printf ( "default  int\n" ) ; 
inportb(RXDATA) ; 
break; 

> 

outportb(PIC00,E0I) ; 

} 

/*  END  ISR’S:  BEGIN  FUNCTIONS  TX  «/ 


/* - */ 

/*  Initiates  TX  Sequence  to  the  ECU  */ 


void  TXit(void) 

{ 

char  extra; 
int  i; 

/*  delay(delaytime) ;  */ 

EnablePC.RXintO ; 

vhile(getbit(inport(LINESTATUS) ,0)) 

■C  extrasinportb(RXOATA) ; 

printf ("Cleared  byte  =  OxZx  »  ’%c’  from  serial  port  RX  buffer.\n", 
(unsigned  char) extra,  extra); 

> 

while (getbit(inportb(LINESTATUS),5)~0)  <putch(*w*);  putch(’!*);  } 
/*  wait  for  TX  to  complete  */ 
if (Command(nxar>=REQ_DEFAULT_THROTTLE) 
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{  outportb(TXDiTA,CoanaBdC]iar}; 

/*  printf ("CharTZtd:  Xu",CoBBandCliax);  */ 

TXtiiM»biostiaw(0,0) ; 

RZ8tream«TEUE:  /*  it  is  szpsctsd  to  rscsivs  s  strsam  */ 
RXindsz«(ELEViTOR-l) ; 

vhils (RXstroam) 

•C  if(  (biostimeCO.O)  >  (TItims  +  (8*FIFTy_BI0S.MILLISEC0HDS)))  ) 

{  printfC’HAK  \n"); 

ClezirWorkVarO ; 

> 

}  I*  and  «hils  RXstroam  */ 

> 

also  /*  Transmit  Sarvo  Control  String  *! 

{  RXstraamsTRUE;  /*  it  is  axpactad  to  racaivo  a  straam  */ 
RXindaz»(ELEViTOR-l) ; 

for(i«ELEViTOR:  i<RUDDER;  i-*--*’)  /*  Transmit  Elovator  thru  Collactiva  «/ 

RXcharsTRUE; 

outportb(TXOATA,RaqBuff [i] ) ; 

TXtima»bio8tima(0,0) ; 

/*  daisy (20);  REMOVE  THIS  DEUY  WHEN  RESTORING  RX  FUNCTION !! !  */ 

vhila(RXchar) 

{  if(  (biostimaCO.O)  >  (TXtima  +  (8*FIFTY.BI0S_MILLISEC0NDS)))  ) 

{  printfC'NAK  \n"); 

ClaarWorkVarO ; 

} 

}  /*  and  whila  RXchar  */ 

>  /*  and  forO  */ 


outportbCTXOATA.RaqBoff [RUDDER] ) ; 

/*  print! ("CharTXad:  Xu",CommandChar);  */ 

TXtima=bio8tima(0,0} ; 

vhila (RXstroam) 

{  if(  (biostima(0,0)  >  (TXtima  +(8*FIFTy_BI0S_MILLISEC0NDS) ) ) ) 
{  printfC'NAK  \n"); 

ClaarWorkVarO ; 

} 

}  /*  and  vbila  RXstroam  */ 

}  /*  and  Elsa  Transmit  Sarvo  Control  String  */ 
CommandCheu:=SERV0_C0NTR0L ; 

}  /•  and  TXit  •/ 


/*  END  TX  DATA:  BEGIN  FUNCTIONS  FOR  RX  DATA  */ 


/*  Racaiving  fron  EVB  ISR:  Eosuraa  ao  arrors  than  pasaas  to  CharRXO  a/ 


void  PC.RX.ISRCvold) 

{  WorkRXdata*lnportb(RZDiTA) : 

/*  putchCWorkRXdata) :  patehC*');  diaplay  valuaa  racaivad  from  EVB  */ 
WorkLinaatat*lnportb(LINESTiTDS) ; 
if((gatbit(WorkLinaatat,3)!aO)| I (gatbit(WorkLina8tat,2) !>0) 1 1 
(gatbit (WorkLinaatat , 1 ) ! «0) ) 

{  ClaarWorkVarO :  printfC'RZ  ERROR:Xo\a",(anaigaad  cbar)WorkLinaatat) ;  } 
/•  Error  ■  TRUE  */ 

alaa 

CharRXO: 

>  /«  and  RX  ISR  */ 


/*  Function  to  racaiva  data  from  tha  HCll  */ 

Z***************************************************************************/ 

void  CharRX(void) 

RXindaz++ ; 

/*  putch(WorkRXdata) ;  */ 

if  (CoiiimandChar>-REq_OEFAULT.THROTTLE) 
avitchCCommandChar) 

caaa  SER.REQ: 

case  REq_DEFAULT_THROTTLE: 
caaa  REq_DEFAULT_SER_VALS : 
if(RXindax  <  SER_ACK_STRING_LENGTH-1) 

AckBuff [RXindex]=WorkRXdata;  /*  put  Sarvo  Settinga  into  array  to  be 

un-concatanatad  */ 

alaa 

ifCRXindax  ==  SER_ACK_STRIi^_LENGTH-l) 

{  ifCWorkRXdata  !=  ChackaumCSER.ACK.STRING.LENGTH.  AckBuff)  } 

/*  Chacka  if  tha  chackaum  ia  correct  */ 
printf ("Chackaum  Error:  RXad  Chackaum=  %x. 

Calculated  Chackaum  ^  Xx  \n",WorkRXdata, 
ChackaumCSER.ACK.STRING.LENGTH ,  AckBuff) ) ; 

alaa  RXatraam=FALSE; 

} 

alaa  {  putch( ’ a ’ ) :  putch( ’ ! ’ ) ;  ClaarWorkVarO ;  } 
break; 

caaa  POT.REq: 

ifCRXindax  <  POT.ACK.STRING.LENGTH-1) 

AckBuff [RXindax]-WorkRXdata;  /*  put  Potantiomatar  valuaa  into  array  to 

be  un-concatanatad  */ 

alaa 

ifCRXindax  »=  POT.ACK.STRING.LENGTH-1) 


•C  ifCUorkRZdata  !-  ClMeksiin(P0T.ACK.STRlMa.LEX6TH.  AckBuff)  ) 

/*  Checks  if  the  chseksum  la  corrset  *! 

printf C'ChccksiiB  Error:  RXsd  ChseksuB*  Xz, 

Calculatod  Chocksum  *  Xz  \ii",UorkRZdata, 

ChscksufflCPOT.ACK.STRING.LEIiaTH .  AckBuff } ) ; 

also  RXstr«aB«FALSE; 

> 

alas  {  putchC’p*):  putch(’!*):  ClaarWorkVarO ;  } 
break; 

default : 

printf  ("Itaknoim  Comnand  Tied  to  EVB  ra<}airing  acknowladgaaiant  in  CharRX: 
Xa\n" .ComnandChar) ; 

RXstraas^FALSE ; 

ClaarWorkVarO ; 
break; 

>  /*  and  svitchO  *! 
else  /*  POT  ACK  from  Servo  Control  */ 

{  ifCRXlndaz  <  P0T_ACK_STRING_LENGTS-1) 

AckBuff CRXlndaz]*WorkRXdata;  /*  put  Potentiometer  values  into  array  to 

be  un-concatenated  */ 

else 

ifCRXindez  ==  POT.ACK.STRING.LENGTH-1) 

{  if(WorkRXdata  !»  Checksum(POT.ACK_STRIMG_LENGTH ,  AckBuff)  > 

/«  Checks  if  the  checksum  is  correct  */ 
printf ("Checksum  Error:  RXed  Checksum^  Xx> 

Calculated  Checksum  =  Xz  \n",WorkRXdatat 
Checksum(POT.ACK_STRING.LENGTH .  AckBuff) ) ; 
else  RXstreamsFALSE; 

} 

else  {  putch(’q’);  putchC’!');  ClaarWorkVarO;  > 

}  /*  end  Pot  Ack  from  Servo  Control  */ 

RXcharsFALSE; 

}  /«  end  function  CharRX  */ 


/* - 

/*  Initialize  semaphores  for  RXing  a  nev  string  from  the  ECU.  */ 


/*********e******e****e********e*****************«**********************«***/ 

void  ClearWorkVar(void) 

{  int  i; 

DisablePC.RXintO ; 

RXstreafflsFALSE ; 

RXchar>FALSE; 

for(i»0;  i<POT_ACK_STRING_LEMGTH;  i++)  AckBuf f [i] »0 ; 

/*  printfC’CWVXn");  */ 

> 
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'  I'",.  v  w 

r 

! 


/*  E3ID  TSAMSFER  FONCTION  OPERiTIOIS:  Bmxi  POTMTIOWETO  *  POSITZ(»  DATA  •/ 


/* - 

/«  Cast«s  values  froa  tLs  RX  buffer  A  displays  thea  to  the  screen 

Z****************************************************************. 


void  DisplayPotDataCunsigned  char  «ra«_pot) 

{ 


clrscrO ; 


printfC 

B 

Pot  ■ 

X3d 

\n". 

printfC 

As 

Pot  ■ 

X3d 

\n". 

printfC 

El 

Pot  ■ 

X3d 

Xu". 

printfC 

Pitch  Pot  » 

%3d 

\n”. 

printfC 

Roll 

Pot  ■ 

X3d 

\n". 

printfC 

Yav 

Pot  ■ 

X3d 

\n". 

printfC"  Gyro 


X7d\n”. 


(int)ra«_pot [B_POT_B] ) ; 
(int)ra«_pot [AZ_POT_B] ) ; 
(int)ra«_pot [EL_POT_B] ) ; 
(int)ra«_pot [PITCH_POT.B] ) ; 
(iBt)rav_pot [ROLL.POT.B] ) ; 
(int)ra*_pot  CYAW_POT_B] ) ; 
ConcatInt(raB.pot[FR0N_6YR0.NSB] , 


rair.pot  CFROM_GYRO_LSB]  )  ) ; 


•/ 

•/ 

'•/ 


Z****************************************************************************/ 

/*  Function  that  calculates  the  present  state  aeasured  by  the  pots  in  rad  */ 
Z****************************************************************************/ 
void  CalculateState (unsigned  char  *ra«_vals,  float  ecal.state) 

double  Bangle,  AZangle,  ELangle,  PitchAngle,  RollAngle,  YavAngle,  GyroRav; 

/*  This  raw  inputs  in  radians  */ 

Bangle  •  (Bslope  *  (double) (<lnt)ra«_valsCB_POT.B]  -  Bdeo)  ); 

AZangle  »  (AZslope  *  (double) ((int)rav_vals[AZ_POT_B]  -  AZdeo)  ); 

ELangle  *  (ELslope  *  (double) ((int)ra«.vals[EL.POT_B]  ~  ELdco)  ); 
PitchAngle  »  (PitchSlope  *  (double) ((int)ra«.vals[PITCB_POT_B]  *■  PitchDCO)  ); 
RollAngle  »  (RollSlope  *  (double) ((int)rav_vals[ROLL_POT_B]  -  RolUX^)  ); 
YavAngle  »  (YavSlope  *  (double) ((int)rav_vals[YAW_POT_B]  -  YavDCO)  ); 
GyroRav  »  ConcatInt(rav.valsCFROM_GYRO_NSB] ,  rav.vals [FRON.GYRO.LSB] ) ; 

cal.stateCX.COORD]  -  (float) (  (double)LENGTB_ARMl  *  cos(Eangle) 

(double)LENGTB.ARN2  *  cos(Eangle  AZangle)  *  cos(ELangle)  ); 
cal.stateCY.COORD]  «  (float) (  (double )LEHGTB_ARM1  *  sin(Eangle) 

(double)LEBGTE.ARM2  *  sin(Eangle  AZangle)  *  cos(ELangle)  ) ; 
cal.state [ALTITUDE]  «  (float) (  ((double)LENGTR_ARM2)  *  sin(ELangle)  ); 
cal.state [PITCB]  *  (float) (  RtoD  *  PitchAngle); 
ced.state [ROLL]  ■  (float) (  RtoD  *  RollAngle); 

cal.state  [YAW]  s  (float)  (  RtoD  *  (Bangle  AZangle  YavAngle)  ); 
cal.state [YAW_D0T]  -  (float) (GyroRav-GyroOff set); 

}  /*  end  of  function  CalculateState  */ 


void  DisplayState (float  *cal.state) 

{ 

int  i; 
clrscrO ; 

for  (i=0;  KNUM.SENSORS ;  i++) 

printf("%f  \n", cal.state [i]); 
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/* - */ 

/*  Loads  calibration  coafficiants  fron  ganaric.cal  a/ 

/a**********************************,******************************,***,*****/ 


▼oid  LoadQanaricCal(void) 

{ 

cal  «  fopan("ganaric.cal".'‘r"); 
f8canf(cal,"Xlf  Xd  ".ftHslopa,  dHdco}; 
f8canl(cal,"Xlf  Xd  ".tlZslopa,  tiZdco); 
f8canl(cal,"Xlf  Xd  ".ItELslopa.  tELdco); 
f8canf(cal."Xlf  Xd  ".tPitcbSlopa,  tPitchDCO); 
fscanf (cal."Xlf  Xd  " .leRollSlopa,  ARollDCO); 
fscanf (cal,"Xlf  Xd  ".kYavSlopa.  tYaid)CO); 
f8canl(cal,"Xd  ”,  tGyroOffsat) ; 
fclosaCcal) ; 


/* - */ 

/a  Ibis  function  loads  dafault  valuas  for  tba  sarvos.  a/ 


/aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa/ 

void  DafaultSarvoValaCvoid) 

printf ("\nSanding  Dafault  Sarvo  Valuas  \n"); 

CoiimandCharaREq.DEFiULT.SEIl.VALS ; 

TXitO; 

SarvoVals [ELEVATOR] a  ELEVATOR.DEFAULT.B; 

SarvoVals [AILEROH] «  AILEROR.DEFAULT.B ; 

SarvoVals [THROTTLE] a  THROTTLE.DEFAULT.B ; 

SarvoVals [COLLECTIVE] aCOLLECTIVE.DEFADLT.B ; 

SarvoVals [RUDDER] a  RUDDER.DEFAULT.B; 

}  /a  and  function  DafaultSarvoValuas  a/ 

/aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa/ 

/a  Raads  joystick  onca,  sats  sarvos  to  that  valua  a/ 

/aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa/ 

void  SatSarvoFronStickCvoid) 

int  i,  jval; 

unsignad  int  joystick [S] ; 

roadstick.array(joy8tick) ; 
for  (i=0;  i<NDM.SERVOS ;  i++) 

< 

if  ((ia=THROTTLE)  II  (i=aCOLLECTIVE)) 
jval  a  (  (((int)  min.b.array[i]) 

+  conv.f actor [i]  a  ((int) jmax[i]  -  (int)joystick[i] ))  ); 

also 

jval  a  (  (((int)  min.b.axTay[i]) 

+  conv.f actor [i]  a  ((int) joystick [i]  -  (int)jmin[i]))  ); 
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jTal  ■  (jT«l  <  (iiit)Mz.b_«rT»7Ci]  ?  jval  :  ■uc.b.urrayCi]); 
RaqBoffCi]  •  (unslgiMd  cbar)  (Jval  >  (iiit)aia_b_urrayCl]  ? 
Jval  :  ■In.b.arrayCl]) : 

> 

> 


Z***************************************************************************/ 

/*  ControlLoop  takas  ganaratas  ona  control  ractor  and  zaits  it  */ 
/*  Also,  it  gats  uncalibratad  atata,  raanlt  is  storad  in  AckBulf  */ 
/*  praviotts  stata  is  storad  in  OldAckBuff  */ 
/m************m*****************************************************0*******/ 


void  ControlLoop (char  ControlSvitch) 

{ 

int  i; 

for  <i»0;  i<POT_ACK_STRIMG_LEMQTH;  i++) 

OldAckBuffCi]  -  AckBoffCi]; 

CoamandChar  «  SERVO.COMTROL ; 
if  (ControlSvitch  !■  ’0*) 

{ 

svitch(ControlSvitch) 

{ 

casa  ’J':  SatSarvoFromStickO ;  braak; 
dafaolt:  braak; 

) 

/*  OalayUatiKLastDalayTina  L00P_0ELAY);  Original  coda  coaanantad  out  */ 
dalaydO);  /adalay  10  nillisaconds :  12  Oct  93*/ 

> 

alsa 

InitDalayTlawrO ; 

ClaarWorkVarO ; 

TXitO: 

} 

/aaaaaaaa********************************^*********************************/ 
/*  Takas  stata  and  sarvo  data  and  doas  vhat  va  tall  it  to  do  */ 
/««*««««aaaaaaa**«a*a*«*«*****aaa****«*****aa*a***a***a****«****a**a********/ 

void  ProcassStataData(char  DataSvitch,  unsignad  char  *Sarvos, 
unsignad  char  *IhicalStata) 

{ 

float  CalStataCNUH.SENSORS]: 
svitch(DataSvitch) 

{ 

casa  *U' :  DisplayPotOata(OncalStata) ; 

braak; 

casa  *D*:  CalculataStata(OncalStata,CalStata) ; 

DisplayStata(CalStata) ; 
braak; 

casa  'S':  CalculataStata(lhicalStata,(^Stata) ; 
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StorsStat* (Servos .  CalStats); 
case  ’O’:  break; 
default:  break; 

> 

} 

/e**************************************************************************/ 

/«  Takes  input  fron  joystick*  to  set  values  for  servos  iteratively  */ 
/*m*m*m*********m*****m****m*****************m******************************/ 

void  DoControlLoopCcbar  (^>ntrolSvitcb,  char  DataSvitch, 
char  UriteControlUithHeuState ,  char  elnitNessage) 

{  int  i; 

printf ("Xs" .InitHassage) ; 

ControlLoopC ’O’); 
while  (ikbhitO) 

{  ControlLoop(ControlSwitch) ; 
if  (UriteControlWithMevState) 

ProcessStateData(DataSvitch.  ReqBuff,  AckBuff); 
else 

ProcessStateData(DataSvitch,  ReqBuff,  OldAckBuff); 

} 

getchO; 

}  /*  End  DoControlLoop  */ 

/*  EMD  SERVO  CONTROL  OPERATIONS:  BEGIN  CALIBRATION  COEFFICIENT  OPERATIONS  */ 
void  nainO 

{  unsigned  char  HenuChoice [3] ; 

int  Continuelt;  /*  used  to  allow  for  continuous  operation  */ 

SerialPortsl ;  /*  set  port  to  com  2;  change  to  com  1,  12  Oct  93  */ 

setup.commO ;  /*  set  up  coaminications  */ 
setup_arrays() ; 

ContinueIt*TRUE ; 

LoadGenericCalO ; 

while(Continuelt) 

printf("\n  Fast  Adaptive  Maneuvering  Experiment  —  PC  Interface  Version 
6,0\n"); 

printfC"  By  Darrell  Duane,  Steve  Suddarth,  G-Z  Sun  \n"}; 

printfC"  (J)oystick  control  of  servo  values\n”); 

printfC  (G) — control  w/  joystick  ...  store  state  in  file  ’filel.tm’\n") ; 

printfC  (C)alibrate  joystick  \n"}; 
printfC  print  calibrated  (S)tate\n"); 

printfC  (Z)  Repetitive  potentiometer  request  (Q)uit  XnVn"); 
scanf ("Xls" ,  HenuChoice) ; 
clrscrO ; 

svitch(toupper (HenuChoice [0] ) ) 
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■ .«  -  '  -■•jV 


{ 

cast  *J*: 

DoControlLoopC’ J’ , ’0' ,TRUE,"aiid«r  joystick  controlNn"); 

/*  Urittsn  by  SCS  and  6-ZS  */ 
break; 
case  ’6': 

OoControlLoop( ’ J* , 'S' .TRUE, "Closed-loop  joystick\n") ; 

WriteStateC'f  ilel  .tm") ; 

ClearStateRecsO ; 
break; 

case  'C': 

cal.joystickO ;  /*  Written  by  SCS  and  6-ZS  */ 

break; 
case  'Q': 

RestoreOldlSRO ;  /*  Restore  the  old  interrupt  service  routine  */ 

ContinueltsFALSE ; 
break; 

case  'X':  /*  Repetitvely  request  potentiometer  value  */ 

DoControlLoop('0' , 'U' .TRUE, "Here's  potentiometers,  press  any  key\n"); 
break; 

case  'S':  /*  Repetitvely  request  calibrated  state  */ 

OoControlLoopC'O' , '0' .TRUE, "Here's  calibrated  data,  press  any  key\n"); 
break; 

default : 

printf ("Invalid  key  hit  #1--  reenter  \n\n"); 
break; 

}  /*  end  svitchO  */ 

}  /*  end  while  loop  for  Continuelt  ~  TRUE  */ 

}  /*  end  main  routine  */ 

/*  END  MAIN  FUNCTION:  BEGIN  MISCELLANEOUS  FUNCTIONS  */ 

/*  Initiedize  communications  with  the  HCll  */ 

void  setup_coimn(void) 

disableO;  /*  General  interrupt  mask  */ 

DisablePC.TXintO ;  /*  Local  TX  mask  */ 
clrscrO ; 

InitSerialPortO ;  /*  Initialize  the  UART:  baud,  port...*/ 

TXindez-0;  /*  Initialize  the  TX  parameters  */ 

InitRXparmO;  /*  Initialize  the  RX  parameters  */ 

DisablePC_RXint() ; 

enableO;  /*  General  interrupt  mask  */ 

> 

/*  Sets  up  arrays  for  indexing  of  various  servos,  etc.  */ 
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void  sotup. arrays (void) 
int  i; 

FILE  •joy_cal_file; 

min.b.array [ELEVATOR]  »  ELEVATOR_LOUER.LIMIT_B; 

D>ax_b_array [ELEVATOR]  =  ELEVATOR_OPPER_LIMIT_B; 
min_b_array [AILERON]  »  AILERON.LOWER_LIMIT_B; 
max_b_array [AILERON]  «  AILER0N.UPPER_L1NIT_B: 
miii_b_array [THROTTLE]  >  THROTTLE_LOWER_LINIT_B; 
maz_b.array [THROTTLE]  ®  THROTTLE_OPPER_LIMIT_B; 
min_b_array [COLLECTIVE]  »  COLLECTIVE_LOWER_LIMIT_B ; 
max_b_array [COLLECTIVE]  =  COLLECTIVE_OPPER_LIMIT_B; 
min_b_aurray [RUDDER]  »  RUDDER_LOWER_LINIT_B; 
max_b_ array [RUDDER]  =  RUDDER_DPPER_LIMIT_B: 

/*  Read  in  joystick  calibration  */ 

if  ((joy_cal_file  =  fopen(JOY_CAL_FILE.  "r"))  !=  0) 

/eadded  !=  0  to  remove  vamings,  12  Oct  93*/ 

for  (i=0;  i<NUM_SERVOS ;  i++) 

fscanf (joy.cal.file,  "Xd,  %d,  %f\n",  kjmin[i],  Ajmaz[i],  Aconv.f actor [i] ) ; 
f clo8e(joy_cal_f ile) ; 

} 

} 

/* - */ 

/*  Calctilates  checksum  of  sequences:  ignores  last  char  ie  ignores  checksum  */ 
Z****************************************************************************/ 

unsigned  char  ChecksumCint  stringlength,  unsigned  char  CheckBuffQ) 

unsigned  char  ChecksumResult  =  0; 
unsigned  int  sum  -  0; 

int  i; 

for(i=0;  i  <  stringlength  -  1;  i++) 
surn+s  CheckBuf f [i] ; 

ChecksumResult  =  (unsigned  char) sum; 
return  ChecksumResult; 

}  /*  end  checksum  function  */ 


/♦ - */ 

/*  concats  2  unsigned  characters  to  an  integer  */ 


/«*e«******ee***e**e*e****ee***«e*ee*ee4i****e*«**eeeeeeeee**ee*eee*e«ee**eee/ 

int  Concatint (unsigned  char  MSbits, unsigned  char  LSbits) 

{  int  result; 

result<‘(unsigned  int}NSbits; 
results (result  «  8); 
resultsresult-t’LSbits ; 
return  result; 
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> 


/* - */ 

/*  Pauses  for  user  to  read  message  on  screen.  */ 


void  WaitForEnter(void) 

{ 

printfC  Press  any  key  to  begin. \n"); 
getchO; 

}  /*  end  function  WaitForEnterO  «/ 

/* - */ 


/*  END  MISCELLANEA  BEGIN  JOYSTICK  *! 


void  readstick(state) 
stickstate  estate; 

unsigned  int  i,  portval; 

/*  delay(2);  REMOVED  WHEN  SYSTEM  IS  SLOWED  DOWN  *! 
i=  0; 

state->lz  =  0; 
atate->ly  »  0; 
state->rx  »  0; 
state->ry  =  0; 

asm  cli;  /*  disable  interrupts  */ 
outportb(GAMEP0RT,0) ; 

while  (  (portval  =  inportb (GAMEPORT)  A  15)!=0  tk  i++<3500) 

i 

if  (portvalAl)  (state->rx)++; 
if  (portvalA2)  (state->ry)++; 
if  (portvalA4)  (8tate->lx)++; 
if  (portvalAB)  (state->ly)++; 

> 

asm  sti;  /*  re-enable  interrupts  */ 

}  /*  End  readstick  */ 


void  readstick_array(stick_array) 
unsigned  int  estick.array ; 


stickstate  state; 
readstick(Astate} ; 
stick.array [ELEVATOR] 
stick.array [AILERON] 
stick.array [THROTTLE] 
8tick_array [COLLECTIVE] 
8tick_array [RUDDER] 

> 


state.ry; 
state. rx; 
state.ly; 
state.ly; 
state . lx ; 
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void  cal_joyBtick<void) 

{  int  i; 

unsigned  int  joystickCB]; 

FILE  vjoy.cal.fils; 

for  (i=0;  i<5;  i++)  {jmin[i]  =  10000;  jmaz[i]  *  0;} 

printfC'Novs  both  joysticks  full  range  to  calibrate,  then  press  key"); 

while  (ikbhitO) 

{  readstick_array( joystick) ; 

for  (i*0;  i<N0M_SERV0S ;  i++) 

<  if  (joystickCi]  <  jminCi])  jmin[i]  *  joystick[i] ; 
if  (joystickCi]  >  jmaxCi])  jmaz[i]  >  joystickCi];  } 

} 

getchO; 

/*  Find  conversion  factors  from  joystick  to  servos  */ 
for  (i=0;  i<NDM_SERV0S ;  i++) 

{  conv_f actor Ci]  = 

( (float )(max_b_arrayCi]  -  min_b_arrayCi])  / 

(float) (jmaxCi]  -  jminCi])); 

} 

joy.cal.file  =  fopen(J0Y_CAL_FILE,  "w"); 
for  (i=0;  i<NUM_SERV0S ;  i++) 
fprintf (joy.cal.file,  "Xd,  Xd,  Xf\n",  jminCi],  jmaxCi], 
conv.f actor Ci] ) ; 
fclose( joy.cal.file) ; 

} 

/****  Creates  a  state  record  and  updates  the  FirstStateRec  **«*/ 

/m***  end  LastStateRec  pointers  ****/ 

StateRec  *6immeRec (void) 

■(  StateRec  sThisStateRec ; 

if ( (ThisStateRec  «  calloc(l,sizeof (StateRec)))  1^0) 

/♦added  !=  0  to  remove  warnings,  12  Oct  93*/ 

{ 

ThisStateRec->NextStateRec  =  OL; 

if  (FirstStateRec ! sOL) 

LastStateRec->NextStateRec  =  ThisStateRec; 
else 

FirstStateRec  =  ThisStateRec; 

LutStateRec  =  ThisStateRec; 

} 

retumCThisStateRec) ; 

> 

char  StoreState (unsigned  char  *ServoVals,  float  *CalState) 

■(  StateRec  *StoreStateRec ; 
int  i; 
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if  ((Stor«StateRec  -  GimneRecO)  0}/*addfld  !=  0,  12  Oct  GSV 
StoreStateRec->TimeInSeconds  = 

/*  (float) (LastDelayTime  -  Fir8tD«layTim«)/(float)SEC0ND_TIME_C00NT;*/ 
(float) (longtimerO  -  FirstDolayTime)  /  (float )SECOND_TIME_COONT; 

/*  LastDelayTime  replaced  with  longtimer  to  record  time  increments  */ 
for(i=0;  i<NUM_SERV0S ;  i++) 

(StoreStateRec->ServoVals) [i]  =  ServoVads[i] ; 
for(i=0;  i<NUM_SENS0RS ;  i++) 

(StoreStateRec->CzdState) [i]  =  CalState[i]; 
retum(TRUE) ; 

} 

else 

retum(FALSE) ; 

} 

void  Writ estate (char  «TheFile) 

{  FILE  eStateRecFile ; 

StateRec  eThisStateRec ; 
int  i; 

if  ((StateRecFile  =  fopen(TheFile,  "w"))  !=  0) 

{ 

ThisStateRec  =  FirstStateRec; 
while  (ThisStateRec) 

{ 

fprintf  (StateRecFile ,  "!(6 . 2f ,  "  ,‘niisStateRec->TimeInSeconds)  ; 

for(ia0:  KNUM.SERVOS;  i++) 

fprintf  (StateRecFile ,  "'/.d,  " ,  (ThisStateRec->ServoValB)  [i] ) ; 
fprintf (StateRecFile , "  ") ; 

for(i=0;  i<NUM_SENSORS ;  i++) 

fprintf  (StateRecFile,  "*/,7.3f ,  ",(ThisStateRec->CalState)  [i]) ; 
fprintf (StateRecFile, "\n") ; 

ThisStateRec  =  ThisStateRec->NeztStateRec; 

} 

} 


void  ClearStateRecs(void) 

{  StateRec  eNextStateRec ; 
while  (FirstStateRec) 

NextStateRec  =  FirstStateRec->NextStateRec; 
free (FirstStateRec) ; 

FirstStateRec  =  NextStateRec; 

} 

FirstStateRec  =  OL; 

LastStateRec  =  OL; 

} 

TIMING  STUFF  eeeeeeeeeeeeeeeeeeeeeeee/ 
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ipragma  inline 

static  void  near  dummy  (void)  {} 


/* - * 

Name  readtimer  -  read  the  complemented  value  of  timer  0 

Usage  unsigned  readtimer  (void) ; 

(from  Borland  C  Library) 

* - 


static  unsigned  near  readtimer  (void) 

asm  pushf 
asm  cli 

asm  mov  al ,  Oh 
asm  out  43h,al 
dummyO ; 
asm  in  al,40h 
asm  mov  bl.al 
dummyO ; 
asm  in  2d,40h 
asm  mov  bh,al 
asm  not  bx 
asm  sti 
asm  popf 
retum(  _BX  ); 

} 

unsigned  long  longtimerO 
{  unsigned  long  btime; 
unsigned  rtime; 

btime  =  biostime(0,0L) ; 
rtime  =  readtimerO; 
if  (btime !=biostime(0,0L)) 
retum(  (biostime(0,0L)«16) 
else 

retum(  (btime«16)  I  rtime) ; 

> 

unsigned  long  LastDelayTime  =  OL; 
unsigned  long  FirstDelayTime  =  OL; 

void  InitDelayTimer(void) 

{  LastDelayTime  =  FirstDelayTime  =  longtimerO; 

} 

/*The  function  DelayUntilO  causes  intermittent  lockups  of  FAMEPC.  Replaced*/ 
/*with  C  function  delayO.  Requires  changing  LastDelayTime  with  longtimerO*/ 
/*so  that  timing  data  is  recorded  in  filel.tm.  Hovever,  records  time  data  */ 
/*recorded  rather  than  time  measured.  R.  Setzer,  12  Oct  93  */ 


/*  Save  interrupt  flag 

*/ 

/*  Disable  interrupts 

*/ 

/*  Latch  timer  0 

*/ 

/*  Waste  some  time  */ 

/*  Counter  — >  bx 

*/ 

/*  LSB  in  BL 

*/ 

/*  Waste  some  time  */ 

/*  MSB  in  BH 

*/ 

/*  Need  ascending  counter 

*/ 

/*  Restore  interrupt  flag 

*/ 

readtimerO) ; 
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unsigned  DslnyUntiKTargstTime) 
unsigned  long  TsrgetTiae; 

if(  (  LastDelayTimeslongtimerO  )  >  TargetTime)  /*  check  for  sri^around*/ 

if  (TargetTiffle-LastDelayTime  >  THIRTY.MimJTES.TINE) 
whileC  (LastDelayTimeslongtimerO)  >  THIRTY.NINUTES.TIME) ; 

else 

retum(l);  /*  busted  d:}adline  */ 

vhile(  (LastDelayTime=longtimer())  <  TargetTime)  ;  /«  normal  ops  */ 

retum(O) ; 

} 

unsigned  long  TimeSinceLastDelay(void) 

{  return  (longtimerO  -  LastDelayTime) : 

} 

float  NS_SinceLastDelay(void) 

{  return  (  (float )TimeSinceLastDelay()  /  (float)MILLISECOND_TIME_COOirr  ); 

> 

/*  END  PROGRAM  */ 
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/*  G«org«  Nason  OaiTsraity  */ 
/*  Dspartmsnt  of  Elsctrical  and  Cou^utor  Enginssring  */ 
/*  */ 
/*  File  namo:  FAMEDEF.h  */ 
/*  */ 
/*  Authors:  Darrsll  Duaus  */ 
/*  Updats  History:  Vsrsion  6.0,  Octobor  ?,  1992  */ 
/*  */ 
/*  Hoadsr  fils  for  FAME  opsrating  program  in  N68HC11  «/ 
/*  •/ 
/* . */ 


«ifndsf  FALSE 
tdsfine  FALSE 
tdefins  TRUE  ! FALSE 
tsndif 


*  masks  used  for  bitwise  operations  on  registers  or  variables  */ 


idefine 

#define 

idefine 

tdefine 

idefine 

tdefine 

#define 

#define 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 

idefine 


MASKO  OxFE 

/♦ 

1111 

1110 

•/ 

HASKl  OxFD 

/* 

1111 

1101 

*/ 

MASK2  OzFB 

/* 

1111 

1011 

*/ 

MASKS  0xF7 

/• 

1111 

0111 

•/ 

MASK4  OxEF 

/* 

1110 

1111 

*/ 

MASKS  OxOF 

/* 

1101 

1111 

*/ 

MASKS  OxBF 

/* 

1011 

1111 

*/ 

MASK7  0x7F 

/* 

0111 

1111 

•/ 

CMASKO  ' 

'MASKO 

/♦ 

0000 

0001 

•/ 

CMASKl  ' 

'HASKl 

/* 

0000 

0010 

♦/ 

CMASK2  ' 

'HASK2 

/* 

0000 

0100 

*/ 

CMASK3  ' 

'MASKS 

/* 

0000 

1000 

•/ 

CHASK4  ' 

'MASK4 

/* 

0001 

0000 

•/ 

CHASK5  ‘ 

'MASKS 

/* 

0010 

0000 

*/ 

CMASK6  ‘ 

'MASK6 

/♦ 

0100 

0000 

*/ 

CMASK7  ' 

'MASK7 

/* 

1000 

0000 

*/ 

ICl.NUM 

0 

/♦ 

number  of 

input 

capture  1  */ 

IC2_NUM 

1 

/* 

number  of 

input 

capture  2  */ 

ICS.NOM 

2 

/• 

number  of 

input 

capture  S  */ 

NUM.IC 

S 

/• 

nximber  of 

input 

captures  in  HCll 

OCl.NUM 

0 

/• 

number  of 

output  compare  1  */ 

0C2_IIUM 

1 

/* 

number  of 

output  coopare  2  */ 

OCS.NUM 

2 

/* 

number  of 

output  coopare  S  */ 

0C4_MUM 

S 

/* 

number  of 

output  conpare  4  */ 

0C6_NUM 

4 

/• 

nusa>er  of 

output  conpare  S  */ 

NUM_0C 

S 

/* 

number  of 

output  conpares  in  HCll 

*/ 


*/ 
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*d«fin«  PAS  3  /«  pin  number  on  port  A  */ 

Adoflno  PA4  4  /*  pin  nombor  on  port  A  */ 

tdefino  PAS  5  /*  pin  number  on  port  A  */ 

Adeline  PAS  6  /*  pin  number  on  port  A  «/ 

Adeline  PBO  0  /*  pin  nuo^r  on  port  A  */ 

Adeline  PBl  1  /*  pin  number  on  port  A  */ 

Adeline  PB2  2  /*  pin  nu]id>er  on  port  A  */ 

Adeline  ICIRISE  0x10  /*bit  pattern  lor  ICl  to  trigger  interrupt  on 

rising  edge  */ 

Adeline  ICIFALL  0x20  /*bit  pattern  lor  ICl  to  trigger  interrupt  on 

lulling  edge  */ 


/*  delines  lor 

initializing 

RAM  ISR  jump  table 

•/ 

/* - 

Adeline 

JUMPEXTENDED  OxTE 

- - - 

/*Assembly  language  inst.  lor  ISR  jump  table*/ 

Adeline 

VSCI 

0x00C4 

/*  Serial  Communications  Interlace 

*/ 

Adeline 

VSPI 

0X00C7 

/*  Serial  Peripheral  Interlace 

*/ 

Adeline 

VPAIE 

OXOOCA 

/*  Pulse  Accumulator 

*/ 

Adeline 

VOAO 

OXOOCD 

/* 

*/ 

Adeline 

VTOF 

OXOODO 

/*  Timer  Orerllou 

•/ 

Adeline 

VT0C5 

0X00D3 

/*  Output  Conpare  5 

•/ 

Adeline 

VT0C4 

0X00D6 

/*  Output  Compare  4 

•/ 

Adeline 

VT0C3 

0X00D9 

/*  Output  Compare  3 

*/ 

Adeline 

VT0C2 

OXOODC 

/*  Output  Compare  2 

*/ 

Adeline 

VTOCl 

OXOODF 

/*  Output  Compare  1 

*/ 

Adeline 

VTIC3 

0X00E2 

/*  Input  Capture  3 

*/ 

Adeline 

VTIC2 

0X00E5 

/*  Input  Capture  2 

*/ 

Adeline 

VTICl 

0X00E8 

/*  Input  Capture  1 

*/ 

Adeline 

VRTI 

OXOOEB 

/*  Real  Time  Interrupt 

*/ 

Adeline  VIRQ 

OXOOEE 

/*  Maskable  Interrupt  Request 

*/ 

Adeline  VXIRQ 

OXOOFl 

/*  Non-Maskable  Interrupt  Request 

*/ 

Adeline 

VSWI 

0X00F4 

/*  Soltware  Interrupt 

*/ 

Adeline 

VILLOP 

0X00F7 

/*  Illegal  Operation 

*/ 

Adeline 

VCOP 

OXOOFA 

/*  Computer  Operating  Properly 

*/ 

Adeline 

VCLM 

OXOOFD 

/*  Clock  Monitor 

*/ 

Adeline 

VRST 

lEOOO 

/*  Restart  Bullalo  Monitor  using  asseimbly 

*/ 

/♦ . 

'*/ 

/* 

Del init ions  lor  Handshaking 

*/ 

/♦ . 

’"*/ 

/*  Disable  TX  data  buller  eo^ty  interrupt  */ 

Adeline  DisableTXbullEnptylntO  ClearBit(SCCB2_Add,7) 

/*  Enable  TX  data  buller  empty  Interrupt  */ 

Adeline  EnableTXbullQiq>tyInt()  SetBit(SCCR2_Add,7) 

/*  Disable  TX  complete  interrupt  */ 

Adeline  DisableTXconpleteIntO  ClearBit(SCCR2_Add,6} 
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/*  Enabla  TX  conplata  intarrupt 
Adafina  EnablaTXcos^latalntO 

SatBit(SCCR2_Add.6) 

•/ 

/*  Disabla  RZ  start  intarrupt 
Adafina  DisablaRZintO 

ClaarBit(SCCR2.Add. 5) 

*/ 

/*  Enabla  RX  start  intarrupt 
Adafina  EnablaRXintO 

SatBit(SCCR2.Add,5) 

•/ 

/*  Disabla  idla  lina  intam^t 
Adafina  DisablaldlaIntO 

ClaarBit (SCCR2.Add , 4) 

*/ 

/*  Enabla  idla  lina  intarrupt 
Adafina  EnablaldlaIntO 

SatBit(SCCR2_Add.4) 

•/ 

idefine  SERVO.CONTROL  0 

«defin«  REQ.DEFiULT.THROTTLE  2S1 
«dafine  REQ.DEFiULT.SER.VALS  2S2 


tdafiiM  DUMHY  253 

*define  POT.REQ  254 
«define  SER.REQ  255 

«defin«  NUM.SERVOS  5 
fdalina  ZEROTH  0 


idefina  ELEVATOR  0 
fdafina  AILERON  1 
Adallna  THROTTLE  2 
idalina  COLLECTIVE  3 
Adafina  RUDDER  4 
idafina  TO.GYRO  5 
tdafina  FROM.GYRO  6 

«dafina  NUN.PULSES  8 


/*  indaz  of  sarvo  control  raquaat  chars 


/*  1.5  ms  pnlsa  always  to  gyro 
/*  input  from  gyro  (YAW_D0T)  */ 


*/ 


/*  numbar  of  pulsas  to  sand  */ 


tdafina  ELEVATOR_S  1 
*dafina  AILERON.S  2 
#dafina  TO.GYRO.S  3 
fdafina  TEROTTLE_S  4 
fdafina  COLLECTIVE.S  5 
Adafina  RUDDER.S  6 
Adafina  FROM.GYRO.S  7 


/*  saquanca  of  sazro  control  output  cooq>aras 


Adafina  AZ_P0T_B  0 
Adafina  ROLL_POT_B  1 
Adafina  EL.P0T_B  2 
Adafina  yAH_P0T_B  3 
Adafina  H_P0T_B  4 
Adafina  PITCH_POT_B  5 
Adafina  FR0M.GYR0_HSB  6 
Adafina  FROM.GYRO.LSB  7 


/•  PE 
/♦  PE 
/*  PE 
/*  PE 
/*  PE 
/*  PE 


*/ 

*/ 

*/ 

*/ 

*/ 

*! 


/*^k  2  Usad  for  satting  DC  offsat  of  gyro  tima*/ 
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id«fin«  SER_iCK_STRIMG_LEI<jTH  6  /*  5  servo  values  k  1  ChecksuB  */ 

tdefine  POT.ACK.STRIMG.LEIIGTH  9  /*  9  pot  bytes  *  8  bytes  1  Checksua  */ 

unsigned  char  ServoVals [MUM.SERVOS] ; 

unsigned  char  ickBuf f [POT.ACK.STRING.LENGTE] ;  /*  TZ  BufXer  for  EVB,  RX  Buffer 

for  PC  */ 

unsigned  char  ReqBuf f [SER.ACK_STRIMG_LEMGTE] ;  /*  TX  Buffer  for  PC  */ 
int  j ;  /*  delay  char  for  TX  */ 


/*  index  variables  «/ 

signed  char  RXindez;  /*  ixidez  of  chars  RXed  from  PC  */ 

signed  char  TXindez;  /*  index  of  char  to  be  TXed  in  the  buffer  */ 

signed  char  TXend;  /*  number  of  chars  to  TX  */ 

/****e«**eee*eeeeee*ee*eeee*  EVB  COM  STATUS  REGISTERS  *****•****«*•**********/ 

unsigned  char  WorkSCSR;  /*  status  register  of  the  SCI  */ 

unsigned  char  WorkRXdata;  /*  work  received  data  */ 

/*  Sephamores  */ 

/*  TRUE  if  there  is  Noise, Framing  error  or  an  Overrun  error  */ 

unsigned  char  NoiseFraming; 

\msigned  char  Ovezrun; 

unsigned  char  UnknovnCommand;  /*  TRUE  if  an  unknown  command  char  is  attempted 

to  be  TXed  */ 

unsigned  char  OCStriggered; 

unsigned  chu  0C4triggered; 

unsigned  char  OCStriggered; 

/* . */ 

/*  Byte  operation  variables  used  to  concatenate  and  cut  bytes  */ 

/* . */ 

unsigned  char  LSBits; 


unsigned  char  MSBits;  /*  LSbits  or  NSbits  to  concat  or  results  */ 

unsigned  int  IntToSplit ; 
unsigned  int  Concat2B; 

/*  Globed  variables  used  to  cut  LongToSplit  into  4  unsigned  char  */ 

unsigned  char  ByteO; 

unsigned  char  Bytel; 

unsigned  char  Byte2; 

unsigned  char  ByteS; 

long  LongToSplit; 

double  DoubleToSplit ; 

unsigned  char  CommandChar  =  *x’;  /*  Teop  til  chksum  and  stop  */ 

/* . */ 
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VARIABLES  DEFIMITIOI 


/*  VARIABLES  DEFIBITIOI 

/* . 

/* . 

/«  VARIABLES  RELATIVE  TO  THE  IlfPUT  CAPTURE  FUMCTIOMS 

/* . 

idafine  RX.RANK  2  /*  Rank  of  the  IC  used  for  Recoivor 

Vdafino  RX.NUN  (RX.RAMX-^l)  /•  Mumbar  of  tha  IC  uaad  for  Racaivar 
•dafina  APN.CHAN.RANK  2  /«  rank  of  tha  pulsa  tkat  givaa  tha  APM 

idafina  TCNT.MAX.VAL  OzFFFF  /*  Maziama  ralua  of  tha  main  16  bit  tiaar 
idafina  OVERFLOW_MAX_VAL  OzFF/*  Maziana  ralua  of  tha  8  bit  ovarflov 
/*  aoftvara  conntar  (saa  typa  dafinition)  *! 
idafina  SET.PIN  TRUE  /*  uaad  by  to  dataraina  nazt  atata  of  output  pin 
idafina  CLEAR.PIN  FALSE  /*  ditto  «/ 


*/ 

•/ 

•/ 

•/ 

*/ 

*/ 

*/ 

*/ 

•/ 

*/ 

•/ 


/«  2  ahz,  500  na  par  clock  cycla  of  tiaar,  ao  2000  clock  cyclaa  *  1  aa  */ 
idafina  0ME_MS  2000  /*  min  accaptabla  tiaa  batvaan  two  RI  riaing  adgaa  */ 

idafina  0NE_P0INT_TW0.MS  2400 
idafina  0NE.PQIirr_THREE_MS  2600 

idafina  0NE_P0INT_FIVE_MS  3000  /*  Sarvo  Midpoint  */ 

idafina  QNE.POIMT.SEVEM.MS  3400 
idafina  ONE.POINT.EIGHT.MS  3600 
idafina  0IIE_P0IIiT_NINE.NS  3800 

idafina  TWO.MS  4000  /*  aaz  accaptabla  tiaM  batwaan  two  RX  riaing  adgaa  */ 


idafina 

idafina 

idafina 

idafina 

idafina 

idafina 

idafina 

idafina 


0NE_MS_B  0  /*  fflin  accaptabla  tiaa  batwaan  two  RX  riaing  adgaa  */ 

0HE.PQI!rr_TW0.MS.B  60 
0NE_P0I!rr.THREE_MS.B  75 

0NE_P0INT_FIVE_MS_B  125  /*  Sarvo  Midpoint  •/ 

0NE_P0INT.SEVEN_MS_B  176 
0NE_P0INT_EIGHT_MS_B  200 
0NE_P0INT_NINE_MS_B  225 

TWO.MS _B  250  I*  aaz  accaptabla  tiaa  batwaan  two  RX  riaing  adgaa  */ 


idafina  IMTER.GROUP.DURATION  24000  /*  coafficiant  uaad  to  kaap  low  tiaa 
conaiatant  batwaan  aach  pulaa.  Thia 
v2G.ua  ia  caluculatad  by 
(4000)  *  6  =  24000.  */ 
idafina  ELEVATOR.LOWER.LIMIT  ONE.MS 
idafina  ELEVATOR.UPPER.LIMIT  TWO.MS 
idafina  AILER0N.L0WER.LIMIT  ONE.MS 
idafina  AILERON.UPPER.LIMIT  TWO.MS 


idafina  THROTTLE.LOWER.LIMIT  ONE.MS  /*  ahould  gat  graan  light  */ 

idafina  THROTTLE.OPPER.LIMIT  TWO.MS  /*  ahould  gat  rad  light  */ 

idafina  COLLECTIVE.LOWER.LIMIT  ONE.POINT.TWO.MS  /*  controla  bind  */ 

idafina  COLLECTIVE.UPPER.LIMIT  ONE.POINT.EIGHT.MS  /*  controla  bind  */ 

idafina  RUDDER.LOWER.LIMIT  ONE.MS 
idafina  RUDDER.UPPER.LIMIT  TWO.MS 


idafina  ELEVATOR.LOWER.LIMIT.B  ONE.MS.B 
idafina  ELEVATOR.OPPER.LIMIT.B  TWO.MS.B 
idafina  AILERON.LOWER.LIMIT.B  ONE.MS.B 
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A1LEIU»_UPPER_LINIT_B  TVO.IQ.B 

THROTTLE_LOVER_LIMIT.B  OME_NS_B  /*  sBoald  g«t  gr*«a  light 
idflfin*  TBR0TTLE_UPPEB_LIM1T.B  TUO.NS.B  /*  should  got  rod  light 
•dslins  COLLECTIVE.LOVER.LIMrT_B  OME.POINT.TVO.HS.B  /«  controls  bind 
idsfins  COLLECTIVE_UPPER_LIMIT_B  0ME_P0I1IT_EIGHT_MS_B  /*  controls  bind 
•dsfins  RUDDER_LOWER_LIMIT.B  OIE.MS.B 
•dsfins  RUIH)ER_UPPER_LINIT_B  TWO.MS.B 

/*  dsfault  ssrvo  rsluss  for  initialization 
hdsfins  ELEVATOR_DEFiDLT  ORE.POIMT.FIVE.HS 

hdsfins  AILEROM.DEFAULT  OME_POIHT.FIVE.NS 

tdsfins  THROmE_DEFAULT  THROTTLE.LOWER.LINIT 

idsfins  COLLECTIVE.DEFAOLT  COLLECTIVE.LOUER.LIMIT 
idsfins  RUDDER.DEFAULT  OirE.POIMT.FIVE.MS 

idsfins  TO.GYRO.DEFADLT  OME.POIIIT.FIVE.MS 

idsfins  ELEVATOR.DEFAULT_B  QNE.POIMT.FIVE.HS.B 
idsfins  AILEROR.OEFAULT.B  ONE.POIHT.FIVE.MS.B 
idsfins  THROTTLE_DEFAULT_B  THROTTLE.LOHER.LIMIT.B 
idsfins  COLLECriVE.DEFAULT.B  COLLECTIVE.LOWER.LIMIT.B 
idsfins  RIIDDER_DEFAULT_B  ONE.POINT.FIVE.NS.B 
idsfins  TO_GYRO_DEFAULT_B  OME_POINT_FIVE_MS_B 


6811  Evaluation  Board  Hardvars  Osfinitions 


idsfins  LATCH.SCI  0x4000  /*  addrsss  of  flipflop  to  snabls  RX  of  data  *! 


/* . */ 

I*  G«n«rat«a  signed,  on  a  Port  A  pin  t  a  Port  B  pin  using  ons  output  */ 

/«  coiapars .  */ 

/*  arrays  are  largsr  than  necessary  so  that  output  block  nunbers  can  be  «/ 

/*  used  as  indices.  */ 

/*  .  .  . '"*/ 

unsigned  int  TestServo;  /*  Data  RXed  to  be  validated  */ 

unsigned  int  Thigh [NUN.PULSES] ;  I*  Buffer  to  store  tisM  high  for  each  pin*/ 

unsigned  int  LowerLinits [NUM_PULSES] ;  /*  Lover  limits  for  Servos  «/ 

unsigned  int  UpperLimits[NUM_PULSES] ;  /*  Upper  limits  for  Servos  */ 

unsic^^ed  int  ServoStatus;  /*  indicates  shich  servo  is  active  */ 

/* . •/ 

/*  VARIABLES  RELATIVE  TO  THE  INPUT  CAPTURE  FUNCTIONS  */ 

/* . */ 

/*  Avaits  Rising  or  Fedling  edge  on  corresponding  pin  on  port  A  and  */ 

/*  triggers  ISR  upon  reciept.  */ 

/* . */ 

unsigned  int  TimeAtRise.ICl ;  /*  timer  value  when  rise  detected  at  PA2  */ 
unsigned  int  TimeAtFall.ICl ; 

/*  used  to  calculate  value  for  unsigned  int  YavDot,  below  */ 

/* . */ 

/*  A/D  CONVERSION  */ 

/* . */ 

/*  Bit  patterns  written  to  ADCTL  to  trigger  A/D  converters  */ 

#define  PEOtoS.AOCTL  OzlO  /*  Scan=off,  Multiple  channel, 

Convert  Port  E  channels  0  through  3  */ 

tdefine  PE4to7_ADCTL  0x14  /*  Scan=off,  Multiple  channel. 

Convert  Port  E  channels  4  through  7  «/ 

tdefine  PEO.AOCTL  0x00  /*  Value  to  load  ADCTL  with  to  meuure  pin  PEO  */ 

tdefine  PEl.ADCTL  0x01  /*  Value  to  load  ADCTL  with  to  meuure  pin  PEI  */ 

tdefine  PE2_ADCTL  0x02  /*  Value  to  load  ADCTL  with  to  measure  pin  PE2  */ 

tdefine  PE3_ADCTL  0x03  /*  Value  to  load  ADCTL  with  to  measure  pin  PE3  */ 

tdefine  PE4_ADCTL  0x04  /*  Value  to  load  ADCTL  with  to  measure  pin  PE4  */ 

tdefine  PES.ADCTL  0x05  /«  Value  to  load  ADCTL  with  to  measure  pin  PES  */ 

tdefine  PES.ADCTL  0x06  /*  Value  to  load  ADCTL  with  to  measure  pin  PE6  */ 

tdefine  PE7_ADCTL  0x07  /*  V2due  to  load  ADCTL  with  to  meeisure  pin  PET  */ 

/* . . . . .  . '*/ 

/*  variables  relative  to  the  position  determination  */ 

/* . */ 

/*  Stand  potentiometer  angles  used  to  determine  the  Cartesian  location  */ 

double  Bangle,  AZangle,  ELangle,  PitchAngle,  RollAngle,  YavAngle; 

int  Gyro; 
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/*  Oac«librat«d  Stand  potantloaatar  anglas  osad  to  datomina  tha  Cartasian 
location  */ 

unaignad  char  Hrav,  AZrav,  ELrav,  PitchRav.  RollRaw,  YavRav; 

/*  First  Voltaga  from  AD  convartar  «/ 

unsignad  char  HvO,  AZvO,  ELvO,  PitchVO.  RollVO,  YavVO; 

/*  Sacond  Voltaga  from  AD  convartar  */ 

unsignad  char  Hvl,  AZvl,  ELvl,  PitchVl.  RollVl,  YavVl; 

idafina  DLYIO  0z4E40  /a  dalay  of  10  ms  in  tarm  of  main  timar  cycla  */ 

/*  Cartasian  A  Rotational  position  of  tha  Halicoptar  */ 

int  Xcord,  Ycord,  Zcord,  Pitch,  Roll,  Yav; 

unsignad  int  YavDot;  /*  diffaranca  batvaan  risa  A  fall  timas,  abova  */ 


ECU  REGISTER  VARIABLES 


unaignad  int  aTCST.Add;  /*  main  timar  countar  ragistar 

unsignad  char  vTMSKG.Add;  /*  main  timar  intarrupt  mask 

unsignad  char  aTFLGZ.Add;  /*  maintimar  flag  ragistar 


•/ 

*/ 

*/ 


unsignad  int  aIC.AddCNUM.IC] ;  /*  pointar  to  input  captura  ragistars.  */ 

unsignad  int  *0C_AddCNUM_QC] ;  /*  pointar  to  output  cos^ara  ragistars  */ 


unsignad  cheor  aTMSKl.Add;  /*  output  cozsfvr*  and  input  captura  int  masks*/ 

unsignad  char  *TFLGl_Add;  /*  output  coiq>ara  and  input  captura  flags  */ 

unsignad  char  *TCTL2_Add:  /*  input  con^ara  trigger  type  */ 
unsigned  char  *TCTLl_Add;  /*  output  compiura  automatic  pin  actions  */ 

unsignad  char  *0ClD_Add;  /■»  output  conpara  1  control:  data  to  sat  into 

PAx  */ 

unsignad  char  *0ClM_Add;  /*  output  compare  1  control:  mask  to  sat  or  not 

PAx  */ 

unsigned  char  *PACTL_Add; 


/* . 

unsignad  char  aSCSR.Add; 
unsignad  char  *SCDR_Add: 
unsignad  char  *SCCR2_Add; 
unsignad  char  *SCCRl_Add; 
unsignad  char  aBAUD.Add; 
unsignad  char  *LATCH_SCI.Add; 
pin  PDO  to  I/O  connector 


SCI  REGISTERS . */ 

/*  status  ragistar  of  tha  SCI: flags  */ 
/*  racaivad  and  transmit  data  ragistar  */ 
/*  intarrupt  enables  and  state  of  SCI  */ 
/*  data  format  8  or  9  bits  */ 
/*  baud  rata  register  */ 


/*  software  controllable  latch  to  connect 
*/ 


/*  Port  A  A  B  registers:  for  sanding  pulses  using  output  cougars  *  */ 

unsignad  char  *P0RTB_Add; 
unsignad  char  *P0RTA_Add; 


/* 


Port  D  ragistars 


*/ 
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unsigned  char 
unsigned  char 
unsigned  char 


ePORTD.idd; 

sDORD.idd; 

«SPCR_idd: 


/*  Port  D 

/*  Data  Direction  for  Port  D 
/*  SPI  Control  Register 


•/ 

*/ 

*/ 


/* . 

unsigned  char  *0PTI0M.idd; 
unsigned  char  sADCTL.idd; 
unsigned  char  elDRl.idd; 
unsigned  char  eADR2_Add; 
unsigned  char  *iDR3_Add: 
unsigned  char  «ADR4.Add; 


A/D  registers  "  ♦/ 

/*  ECU  registers  ♦/ 

/«  Control  Register  for  A/D  converter  */ 


/«  loc  where  converted  values  are  stored  *! 


EEPROM  prograioming  registers  "  ""  "♦/ 
unsigned  chaur  *PPR0G_Add:  /«  ECU  registers  */ 
unsigned  char  *C0NFI6_Add; 


/* . . 

/*  Declaration  of  the  Ell  register  addresses  defined  in  the  library 
/*  c:\introl\kjh\kjhstart.oll 

/* . 


extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 


char  EllPORTA; 
char  EllPIOC; 
char  EllPORTC; 
char  EllPORTB; 
char  EllPORTCL; 
char  EllDDRC; 
char  EllPORTD; 
char  EllDDRD; 
char  EllPORTE; 
char  EllCFORC; 
char  EllOClN; 
char  EllOClD; 


/*  i/o  port  A 

/*  parallel  i/o  control  register 
/*  i/o  port  C 
/*  i/o  port  B 
/*  alternate  latch  port  C 
f*  data  direction  for  port  C 
/*  i/o  port  D 

/«  i/o  data  direction  for  port  D 
/*  i/o  port  D 
/*  coD^are  force  register 
/*  OCl  action  ouisk  register 
/*  OCl  action  data  register 


*/ 

*/ 

*/ 

*/ 

*/ 

*/ 

*/ 

*/ 

•/ 

•/ 

*/ 

*/ 

*/ 

*/ 

♦/ 

*/ 


extern  unsigned  int 
extern  unsigned  int 
extern  unsigned  int 
extern  unsigned  int 
extern  unsigned  int 
extern  unsigned  int 
extern  unsigned  int 
extern  unsigned  int 
extern  unsigned  int 


EllTCNT 

EllTICl 

E11TIC2 

E11TIC3 

EllTOCl 

E11T0C2 

E11T0C3 

E11T0C4 

E11T0C5 


/*  timer  counter  register  */ 
/*  input  capture  register  1  e/ 
/*  input  capture  register  2  e/ 
/*  input  capture  register  3  */ 
/*  output  compare  register  1  *! 
/*  output  co])q>are  register  2  */ 
/*  output  conq>are  register  3  */ 
/*  output  compare  register  4  */ 
/*  output  compare  register  5  */ 


extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 
extern  unsigned 


char  EllTCTLl 
char  E11TCTL2 
char  EllTNSKl 
char  E11TFL61 
char  E11THSK2 
char  E11TFLG2 
char  EllPACTL 
char  EllPACNT 


/♦  timer  control  register  1  */ 
/*  timer  control  register  2  */ 
/*  main  timer  interrupt  mask  1  */ 
/*  main  timer  interrupt  fleig  1  */ 
/*  main  timer  interrupt  mask  2  */ 
/*  misc  timer  interrupt  flag  2  */ 
I*  pulse  acc  control  register  *! 
/*  pulse  acc  count  register  */ 
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•xt«r&  uuigii«d  char  HllSPCE;  /*  SPI  control  rogistor  «/ 

•ztom  nnnignod  char  HllSPSR;  /*  SPI  status  rsgistsr  «/ 

sztsm  unsignsd  char  HllSPDR;  /*  SPI  data  in/out  */ 

•xtsm  unsignsd  char  HllBiUD;  /*  SCI  baud  rats  control  */ 

sztsm  unsignsd  char  HllSCCRl;  /*  SCI  control  rsgistsr  1  */ 

sztsm  unsignsd  char  H11SCCR2:  /*  SCI  control  rsgistsr  2  */ 

sztsm  unsignsd  char  HllSCSR;  /*  SCI  status  rsgistsr  */ 

sztsm  unsignsd  char  HllSCOR;  /*  SCI  data  */ 

sztsm  unsignsd  char  HllADCTL;  /«  A  to  D  control  rsgistsr  */ 

sztsm  unsignsd  char  HlliORl;  /*  A  to  D  rssult  1  */ 

sztsm  unsignsd  char  H11A0R2;  /*  A  to  D  rssult  2  */ 

sztsm  unsignsd  char  HllAORS;  /*  A  to  D  rssult  3  */ 

sztsm  unsignsd  char  H11ADR4;  /«  A  to  D  rssult  4  */ 

sztsm  unsignsd  char  EllOPTION;  /*  Systsm  configuration  options  */ 

sztsm  unsignsd  char  HllCOPRST;  /*  am  /rssst  COPtimsr  circutry  */ 

sztsm  unsignsd  char  HllPPROG;  /*  EEPROM  prograoning  control  */ 

sztsm  unsignsd  char  HllEPRIO;  /*  highest  priority  I  bit  and  misc*/ 

sztsm  unsignsd  char  HllINIT;  /*  RAM  /io  mapping  rsgistsr  */ 

sztsm  unsignsd  char  HllTESTl;  /*  factory  tsst  control  */ 

/*  COP.  ROM.  AEEPROM  snablss  */ 
sztsm  unsignsd  char  HllCONFIG; 

tdsfins  ACIASR. ADDRESS  0z9800;  /*  ACIA  status  rsgistsr  */ 

idsfins  ACIADR.ADDRESS  0z9801:  /«  ACIA  data  rsgistsr  */ 


unsignsd  char  «ACIASR_Add: 
unsigned  char  sACIADR.Add; 

unsignsd  char  gstit;  /*  Bytes  vhsrs  data  is  RXsd  */ 

/sssssssssssssssssssssssssssssssssssssssssssssssssssssssssssssssssssssssss/ 

/*  PROTOTYPES  •/ 

/*  functions  for  msasiiring  pots  and  calculating  positions  and  angles  *! 

I*  FAMEINIT.c:  FAME  Project  General  Initialization  Functions  */ 

void  InitConstantVariablss(void) ; 
void  InitPointer(void) ; 
void  InitADconvertsr(void) ; 

/*  FAMEINI2.C:  FAMEMAIN  Specific  Initialization  Functions  */ 

void  InitVsctorTabls(void) ; 
void  InitSsrvos(void) : 

void  SCI_init_TX(void) ;  /*  initializes  TX  to  PC  ♦/ 

void  SCI_init_RX(void) ;  /*  initialize  for  reception  over  SCI  */ 

void  ACIA_init(void) : 

void  InitOCCint  OCnum.  int  Enable) ; 

void  InitlCs(void) ; 
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/«  FAMEISR.C  ISRs  «>/ 


void  OCS.ISRCvoid) ; 
void  ICl_ISR(void) ; 

/«  FINENAIH.C:  Tranamissioo  /  Acknovlogoneat  prototypes  «/ 

void  DocodsAndStorsSsrvoByts(void} : 

void  FillPotAckBuffCvoid); 

void  FillSsrAckBulf (void) ; 

void  TXackBulf (void) ; 

void  ProcessUorkRXdataCvoid) ; 

/*  int  mainCint):  •/ 

void  putBytsCunsignsd  char  putit);  t*  Ties  byte  to  PC:  B3rts  TXsd  is  found 

in  putit  •/ 

/*  FAMELIB.C:  functions  for  doing  basic  bit  operations  on  register  settings*/ 

void  SplitIntCint  i);  /*  function  that  calls  asm  function  below  */ 

int  Concatint (unsigned  char  MSbi  unsigned  char  LSbits); 

unsigned  char  Checksuffi(int  maxuuni,  unsigned  char  CheckArrayC]) ; 

void  ClearBit (unsigned  char  *pointer,int  NumBit); 

void  ClearFlag(unsigned  char  «pointer,int  NumBit); 

void  SetBit (unsigned  char  epointer.int  NumBit); 

unsigned  char  GetBit (unsigned  char  «pointer,int  NumBit); 

unsigned  char  6etBitChar(unsigned  char  reg.int  NumBit); 

/*  ASSEMBLY  Routines  */ 

void  splitlnt(void) ;  /*  assy  lang  to  prepare  pos  values  for  TX  to  PC  */ 

void  concatint (void) ; 

void  getByte(void) ;  /*  loops  until  Byte  is  RXed:  Byte  is  placed  in  getit*/ 
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/*«*««**«««**«««* 

/*  Filaname:  PCdef.h  V«r  5.0  .  1992  *! 

/*  */ 
/♦  definitions  for  FAMEPC.c  ♦/ 

/««eee4i4i*«*«««««4<e«ee*ee*««**«:ti4>«»«««««eee«e«**«eeeee*eeeeeee««e*«***eeeeeee«/ 

/eeeeeeeeeeeeeeeeeeeeeeeeeeeeeee  SERVOS  eee*ee**e««eeee*eeeeeeee*e*«***eee«/ 

unsigned  char  Servoinc [NUM.SERVOS] : 
unsigned  char  EVBservoVals [NUM.SERVOS] ; 
void  DefaultServoVals(void) : 
void  VeoriableServoValsCvoid) ; 
void  UserEnteredServoVals(void) ; 
void  DisplayServoVals(void) ; 
void  DisplayEVBservoVadsCvoid) ; 
void  EqualizeServoVals(void) ; 

/eeeeeeeeeeeeeeveeeeeeeee***  POTENTIOMETERS  ^^*^^****^^*****^n^*^nn^K^n^*********| 
int  G3rroRav:  /*  raw  vadue  of  gyro  */ 

CALIBRATION  eeeeeeeeeeeeeeeeeeeeeeeeeee*****/ 


♦define  PI  3.14159265359  f*  value  for  pi  ♦/ 

double  PiOverTwo=l .5707963268;  /*  compute  the  constant  for  later  use  */ 
double  Pi0verFour=0. 7853981634;  /*  compute  the  constant  for  later  use  */ 
redefine  RADIANS.TO.DEGREES  57.2957795131  /econversion  */ 

♦define  DEGREES.TO.RADIANS  0.0174532925199 
double  RtoD  =  RADIANS.TO.DEGREES; 
float  DtoR  =  DEGREES.TO.RADIANS; 


♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 


H.ANGLEO  0  /*  calibration  location  0  for  H  pot  ♦/ 

H.ANGLEl  (PI) 

EL.ANGLEO  0 

EL.ANGLEl  (-PiOverFour) 

AZ.ANGLEO  0 
AZ.ANGLEl  (PiOverTwo) 

Pitch_ANGLE0  0 

Pitch.ANGLEl  N/A  /*  this  value  prompted  for  from  user  */ 
Roll.ANGLEO  0 

Roll.ANGLEl  N/A  /*  this  value  proiq>ted  for  from  user  *f 
Yaw.ANGLEO  0 
Yaw.ANGLEl  (PiOverTwo) 

ATOD.ERROR.LIMIT  10  f*  sum  of  max  differences  in  four  A/D  samples  */ 


double  Hslope,  AZslope,  ELslope,  PitchSlope,  RollSlope,  YavSlope; 

int  Hdco,  AZdco,  ELdco,  PitchDCO,  RollDCO,  YawDCO,  GyroOffset;  /eDC  offsets*/ 


int  PotChoice;  /*  Choice  of  potentiometer  to  calibrate  */ 

int  PrintValue;  /*  Value  to  print  to  screen  when  using  Defines  */ 

FILE  ♦cal;  /*  file  pointer  for  cadibration  coefficients  ♦/ 
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void  LoadCalVals(void) ; 
void  SavoCalValsCvoid) ; 
void  DiaplayCalValaCvoid) ; 
void  PrintPotOptionaCvoid) ; 
void  PrintOtharOptionsCvoid) : 
unsigned  char  NeasurePotCvoid) ; 
void  EditCoelficientsCvoid) ; 
void  IntemalCal(void) ; 
void  CalibrateinglesCvoid) : 

POSITION  **********************************/ 

void  DisplayCalPotDataCvoid) : 


/*^i^***m***m******m***m*****  KEYBOARD  CONTROL  eeee*******e*ee*e*e*eee**eee«/ 

int  ContinueKeyboard;  /*  indicates  whether  PC  should  continue  accepting 

keystrokes  to  vary  servo  control  values.  */ 
void  KeyboardServoVals(void) : 


/eeeeeeeeeeeeeeeeeeeee*******  DYNAMIC  CONTROL  *****************************/ 
int  ContinueControl; 

int  UpdateStep;  /*  used  to  indicate  point  at  which  function  is  in  for 

varying  transfer  values  real  time  */ 

typedef  struct  StateDummyC 
float  Xcord, 

Ycord, 

Zcord, 

Pitch, 

Roll, 

Yaw, 

Gyro;  }  STATE; 

STATE  Zero;  /*  Vector  of  Zeros  */ 

STATE  ElevatorDoub,AileronDoub,ThrottleDoub,CollectiveDoub,RudderDoub; 

STATE  ElevatorInt , Aileronint ,ThrottleInt ,CollectiveInt ,RudderInt ; 

STATE  ElevatorProp , AileronProp ,ThrottleProp , Collect iveProp , RudderProp ; 

STATE  Ele vatorDoubCr , AileronDoubCr , Thr ottleDoubCr , Collect iveDoubCr , RudderDoubCr ; 
STATE  Ele vator Inter  ,AileronIntCr  ,ThrottleIntCr ,CollectiveIntCr , Rudder IntCr ; 
STATE  ElevatorPropCr , AileronPropCr , ThrottlePropCr , CollectivePropCr , RudderPropCr ; 
STATE  Doub, Int, Prop; 

STATE  Present, Desired; 

STATE  ErrorMinusOne , ErrorMinusTwo , ErrorNinusThree , ErrorMinusFour ; 

/*  Prop  serves  as  Error  */ 
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STATE  *ToChaiig«Ooub ,  *ToCh«ng«Iiit ,  *ToClia]ig«PTop; 

STATE  «Chang«Rat«Ooub ,  *Chang«Rat«lnt ,  *Chang«Rat*Prop; 

FILE  ^Transfer; 

void  LoadTranaferValsCvoid) ;  /*  also  loads  Changs  rates  «/ 

void  SaveTransferVals(void) ;  /«  also  saves  CSiange  rates  «/ 

void  DisplayTransferVals(void) ; 

void  DisplayChangeRates(void) : 

void  DtvCSTATE  *DisplayIt) ; 

void  DisplayVector(STATE  etodisp); 

void  DisplayError(void) ; 

void  EditTransferVals(void) : 

void  Edit (STATE  etoedit); 

void  UpdateTransferVals(void) : 

void  CopyState (STATE  «Copy,  STATE  eOriginal); 

void  Add(STATE  *Equals,  STATE  eFirst,  STATE  eSecond); 

void  Subtract (STATE  ^Equals,  STATE  *First,  STATE  eSecond); 

void  SubtractRot (STATE  «Equals.  STATE  «First,  STATE  eSecond); 

void  CalculateState (unsigned  char  eraw.vals,  float  ecal.state); 

void  DisplayState (float  *cal_state): 

signed  char  Sumit All (STATE  *Doub,  STATE  *ServoDoub,  STATE  *Int,  STATE  eServoInt, 

STATE  *Prop,  STATE  eServoProp); 

signed  char  Sumit AllPrint (STATE  *Doub,  STATE  eServoDoub,  STATE  eint, 

STATE  *ServoInt,  STATE  *Prop,  STATE  *ServoProp); 
void  SaveDesiredCalPotData(void) ; 
void  DynamicControl(void) : 
void  PDServoVals(void) ; 

/eeeeeeeeeeeeeeeeeeeeeeeeeee******  TX  *e«**e*e»*ee*«ee«eeeee*eeee*e*****eee/ 


/* - Serial  Port  Addresses - 

/*  8250  UART  base  port  kddxw.  C0Mls0x3f8  ,  C0M2=t)z2f8 

/* - 

int  Seri2dPort=l;  /*  COMl  or  C0N2 


#define 

BASE 

(0x3f 8- ( (SerialPort-1 ) «8) ) 

4def ine 

TXDATA 

BASE 

/♦ 

transmit  data  */ 

idefine 

RXDATA 

BASE 

/* 

receive  data  */ 

#define 

DIVLSB 

BASE 

/• 

baud  rate  divisor  Isb 

*/ 

tdefine 

DIVMSB 

(BASE+l) 

/* 

baud  rate  divisor  msb 

*/ 

#define 

INTENABLE 

(BASE+1) 

/* 

interrupt  enable  */ 

tdefine 

INTIDENT 

(BASE+2) 

/• 

interrupt  ident’n  */ 

tdefine 

LINECTL 

(BASE-^3) 

/* 

line  control  */ 

tdefine 

MODEMCTL 

(BASE+4) 

/* 

modem  control  */ 

tdefine 

LINESTATOS 

(BASE-^5) 

/* 

line  status  */ 

tdefine 

MODEHSTATUS 

(BASE-)-6) 

/* 

modem  status  */ 

/a  ..... 

serial  interrupt 

/♦  —  —  - 

tdefine 

IRQ  (4-(SeiialPort-l)) 

/• 

0-7  =IBqO  -  IRQ7  ♦/ 

*/ 

*/ 

*/ 
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idefine  SERIALINT  (12  -(SerialPort-1)}  /*  intem^>t  vector  */ 
idefine  SERIALIRQ  ('(1  «  IRQ)) 

tdefine  PICOl  0x21  I*  82S9  programmable  interrupt  controller  */ 

#define  PICOO  0x20  /*  "  "  '•  "  ♦/ 

idefine  EOI  0x20  /«  End  of  interrupt  command  */ 

/* - Modem  control  register - */ 

idefine  DTR  1 

idefine  RTS  2 

idefine  0UT2  8 

int  PARITY  =0;  /*  parity  none  */ 

int  STOPBITS  =1;  /♦  1  stopbit  or  2  •/ 

int  WOROLEN  =8;  /*  length  of  the  data  or  7  */ 

int  BAUD  ’=19200; 

/♦ - serial  port  initialization  parameter  byte - */ 

static  union  { 
struct { 

unsigned  vordlen  :  2; 
unsigned  stopbits  :  1; 
unsigned  parity  :  3; 
unsigned  brk  :  1; 

unsigned  divlatch  :  1; 

}  serial.initial.bits ; 
char  serial.initial.char ; 

}  initserial; 

I*  LoceQ  mask  to  enable, disable  TX  interrupts  */ 

idefine  EnablePC.TXintO  outportb(INTENABLE,setbit(inport(INTENABLE) ,1}) 

idefine  DisablePC.TXintO  outportb(INTENABLE,clearbit(inportb(INTENABLE} ,1}) 

idefine  0NE_BI0S_SEC0ND  20 

idefine  ONE.qUARTER.BIOS.SECOND  5 

idefine  FIFTY.BIOS.MILLISECONDS  1 

long  int  TXtime;  /*  time  values  are  Tied  */ 

static  void  (interrupt  far  eoldserialint) (void) ; 

static  void  interrupt  far  newserialint(void) ; 

void  InitSerialPort (void) ; 

void  initi2QizeISR(void) ; 

int  readserial(void) ; 

int  vriteseriaKvoid) ; 

void  cle2u:_seried_queue(void) ; 

void  RestoreOldlSR(void) ; 

void  TXit(void): 

/eeeeeeeeeeeeeeeeeeeee************  RX  *ee*ee*e*e*e*e******ee****eeeeee*ee*e/ 
idefine  EnablePC_RXint()  outportb(INTENABLE,setbit(inportb(INTENABLE) ,0)) 
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tdafina  DisablaPC.RZlntO  outportb ( In  i'EUABLE ,  claarbit  (  inportb ( IlimABLE) ,  0)  ) 
idafina  RXint.Enablad  gatbit(lnportb(I8TEMABLE) .0) 

int  Rlstraam;  /«  Samaohora  to  indicata  StraaB  baing  RZad  */ 

int  RXchar;  /«  Samaphora  to  indicata  Char  RXad  «/ 

unsignad  char  WorkLinaatat ;  /*  racaption  linaatatus  */ 

unaignad  char  RXconqplata;  /*  aaphamoxa  aat  whan  tha  atraan  ia  corract  */ 

unaignad  char  NavData;  /*  aaphamora  aat  «han  nav  valuaa  ara  RXad  */ 

void  InitRXp2Lrm(void} ; 
void  ClearUorkVar(void) ; 

unaignad  char  ChackaumCint  maznuffl,  unaignad  char  Checklrray □  ) ; 
void  ChuRKvoid) ; 
void  PC_RX_ISR(void) ; 

/m*******************************  RISC  *aaa***a*«*****a*a**aa*aaa*a*«*a*«a*/ 

#dafina  SOUNDDELAY  4 

FILE  afopanO ; 

int  fcloaaO; 

void  WaitForEntar(void) ; 

int  povar(int  a,  int  b); 

long  ConcatLong(unaigned  char  BytaO,  unaignad  chetr  Bytal,  unaignad  char  Byta2, 
unaignad  char  Byta3); 

doubla  ConcatLongD (unaignad  char  BytaO,  unaignad  char  Bytal,  unaignad  char  Byta2, 
unaignad  char  BytaS) ; 


/♦  Communication  Prototypaa  ♦/ 

void  LoadGanaricCal(void) ; 

/*  Baaic  prototypaa  */ 

void  aatup.commCvoid) ; 
void  aatup.arrayaCvoid) ; 

/*  Joyatick  dafinaa  and  prototypaa  «/ 

«dafina  GAMEPORT  0x203 

typadaf  atruct  {unaignad  int  lx,  ly,  rx,  ry;}  atickatata; 
void  raadatickCatickatata  a) ; 
void  raadatick.arrayCunaignad  int  a) ; 
void  cal_joyatick(void) ; 

#dafino  J0Y_CAL_FILE  "joycal.O" 


float  conv.factor [5] ; 

unaignad  int  jminCB] ,  jmax[5] ;  /a  Joyatick  czdibration  a/ 
/a  miacallanaoua  changaa  a/ 
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unsigned  chsr  OldAckBulf [POT.ACK.STRING.LEMGTH] ;  /*  stores  one  history  */ 

void  SetServoFromStick(void) ; 

void  ControlLoopCchar  ControlSvitch) ; 

void  ProcessStateDataCchar  DataSvitch,  unsigned  char  eServos, 
unsigned  char  eUncalState) ; 

void  DoControlAndDataLoop(char  ControlSvitch,  char  DataSvitch, 
char  WriteControlWithNevState,  char  elnitHessage) ; 

unsigned  PreviousControlTime ;  /«  Keeps  track  of  vhen  last  control 

emd  vas  sent  */ 


void  DisplayPotDataCunsigned  char  *rav_pot); 
int  delaytime  -  0;  /*  time  to  delay  betveen  TI  */ 


#define  NUM.SENSORS  7 

#define  PITCH  0 
«define  ROLL  1 
#define  ALTITUDE  2 
«define  Y.COORD  3 
«define  YAW  4 
idefine  X.COORD  5 
tdefine  YAW.DOT  6 

float  state [NUM.SENSORS] ; 

typedef  struct  state.rec  •( 

float  TimelnSeconds; 

unsigned  char  ServoVals [NUH.SERVOS] ; 

float  CalState [NUM.SENSORS] ; 

struct  state.rec  oNextStateRec; 

> 

StateRec ; 

StateRec  eFirstStateRec  =  OL; 

StateRec  eLastStateRec  =  OL; 

StateRec  eGimmeRec (void) ; 

char  StoreState (unsigned  char  eServoVals ,  float  eCalState); 
void  WriteState(char  eTheFile); 
void  ClearStateRecs(void) ; 

TIMING  STUFF  *♦*♦*♦♦/ 

«define  SECOND.TIME.COUNT  1193000L 

fdefine  THIRTY.MINUTES.TIME  ((unsigned  long)(SEC0ND.TIME.C0UNTel800)) 
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•dflfin*  NILLISEC01ID.TINE.C0Uirr  1193L 

idafin*  LOOP_DEUY  ((imslgnad  long)  (20L  «  MILLISECOND.TINE_C:ODirr} ) 

nnsignad  long  longtiBar(void) ; 

unsigned  OelayUntil (unsigned  long  TargatTisw); 

void  InitDeleyTimor(void) ; 

unsigned  long  TimeSinceLestDelsy(void) ; 

float  MS.SincaLastDelayCvoid) ; 

extern  unsigned  long  LastDelayTime ,  FirstDelayTiM ; 

tdefine  clearbit(reg.MumBit)  (  (unsigned  charXreg)  k  (OxFE«(IiuBBit)}  ) 
tdefine  setbit(reg,NuaBit)  (  (unsigned  cbaT)(rag}  |  (0x01«(lluBBit))  ) 
tdefina  gatbit(rag,NuaBit)  (  (unsigned  char)(reg)  k  (0x01«(IuBBit})  ) 

unsigned  int  min_b.arrayC5] ,  max.b.arrayCS] ; 

/*  array  to  store  servo  maz/min  */ 

void  putByte (unsigned  char  putlt);  /*  Ties  byte  to  PC:  Byte  Tied  is  found  in 

putlt  •/ 
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Appendix  B.  MATLAB^  .m  Files 

Listed  below  are  the  various  MATLAB®  .m  files  used  in  prototyping  the  emulator  and  con¬ 
troller  neural  networks. 

function  [Uo,Wi,«]  «  bkprp(z,d,Wo,Wi,«ta) 

%  function  CWo,Wi,«j  ■  bkprp(z,d,Wo,Ui,«ta) 

% 

%  X  -input  data  vector 
%  d  -daairad  output  vector 
X  eta  -  step  size 
X  Wo  -  output  weights 
X  Wi  -  input  weights 
X 

X  Backpropagation  routine  through  a  NN  with  a  linear  input  layer,  sigmoid 
X  transfer  function  at  the  hidden  layer,  and  a  linear  outpnr  layer. 

[p,  nl]  c  size (Wo);  X  p  -  #  of  output  nodes 
[n,m]  s  size(Wi);  %  n  -  §  oi  hidden  nodes 

X  m  -  #  of  input  nodes 

XeeeeeeeeeeeeeeeeeeeeeeeeeForward  propagation******************************* 

u  =  Wi* [z  ;  1] ;  Xinput  vector  to  hidden  layer 
a  =  (one8(n,l)-*-ezp(-u)) .  *(-1) ;  Xoutput  vector  of  hidden  layer 
z  s  Wo* [a  ;  1] ;  XNN  output  vector 

X*************************************************************************** 

X*****************************Backpropagation******************************* 

e  s  d-z;  Xerror  at  output 

deltiiEWo  s  -e* [a  ;  1] ' ;  XEqui valent  error  at  hidden  layer  output 

Wo  =  Wo  -  eta*deltaEWo ;  XOutput  weight  correction 

deltaEWi  3-([diag(a.*(one8(n,l)-a)),  zerosCn,!)] )*Wo'*e*[z; 1] * ; 

XBrror  at  input 

Wi  =  Wi  -  eta*deltaEWi;  Xinput  weight  correction 

%mm*****^>tm****m*m******m*****«**********m***m****«***************m****0**** 
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X*************************************************************************** 

X  tratail.B 

X 

X  It«rativ«  routine  to  train  tail  rotor  eanlator.  Calls  NATLAB  function 
X  bkprp.m.  Data  structure:  throttle.rudder.state(k) ,  state(k-l},  state(k-2} 
Xeeeeeeeee.eeeeeeeeeeeeeeeeeeeee******************************************.** 

clear; 

load  fame;  X  Ezeo^lar  file 

famenorm  -(faBe./25S) ;  X  Monsalize  data 

Unorm  =  f amenormC 1:300,1: 5) ' ; 

[m.j]  s  sizeCDnorm);  X  size  of  the  input  vector  u  -  nzj 

n  =  15;  X  A  of  hidden  nodes 

D3fainenorm(l:300,6) * ;  X  desired  output 

Cp,j]=size(D) : 

eta=.001;  X  step  size 

Uo  =  rand(p,n-«-l)  -.5;  Xcreates  the  input  and  output  veights  randomly 
Wi  =  randCniHH-l)  -.5; 

1*1: 

while  1  <  10000  Xloops  through  number  of  epochs 
for  k  =  l:j  Xloops  through  all  input  vectors 
u  =  Unorm( : ,k) ; 
d  =  D(:,k); 

[Wo,Wi,e]  *  bkprp(u,d,Wo,Wi,eta) ; 

E(:.k)  =  e; 
end 

error=sum(.5*(E. *2) ’) ; 
mserr ( 1 ) =err or ; 
l=l-*-l; 
end 

save  tmtail  Wo  Wi  mserr;  X  save  weight  and  error  in  file  "tmtail.mat" 
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X  check. B 

X 

X  Forward  propagation  through  NN.  Output  is  cos^ared  with  desired  and 
X  plotted . 

X******************-*******************************-************************** 

load  famenew; 
f  afflenorm^afflenev .  /25S ; 


X  X  -input  data  vector 
X  d  -desired  output  vector 
X  eta  -  step  size 
X  Wo  -  output  weights 
X  Wi  -  input  weights 

X  =  famenormC: ,1:5)’ ; 

d  =  f amenormC : , 6 : 8) ’ ; 

[m,j]=size(x) ; 

[p,  nl]  =  size (Wo); 

Cn,ni]  =  size(Wi); 

X  p  -  #  of  output  nodes 
X  n  -  #  of  hidden  nodes 
X  m  -  #  of  input  nodes 

Xe*eee*ee******e*ee***eee*Forward  propagationeeeeee*e*ee***e*eeeeeeeeee*e'^e* 
u  =  Wi*Cz  ;  ones(l,j)];  Xinput  vector  to  hidden  layer 
a  =  (ones(n, j)+exp(-u)) .*(-1) ;  Xoutput  vector  of  hidden  layer 
z  =  Wo*Ca  ;  onesCl.j)];  XNN  output  vector 

Xe*ee****e’i‘****e*e**e**ee**eee**e*e*e**e*eee*e***e******e******e***eeee*ee*e 

plotCl: j , Cz;d]) 

err  =  .5*sum<(z-d) . *2) 


82 


Appendix  C.  Derivation  of  Backpropagation 

C.l  Emulator 

The  objective  in  backpropagation  is  to  minimize  error  with  respect  to  the  neural  network 
weights  using  a  gradient  decent  technique.  In  this  section,  we  will  first  consider  backpropagation 
through  the  emulator  NN  with  one  hidden  layer  using  a  sigmoid  transfer  function 

and  linear  input  and  output  layers  (Figure  21),  which  will  be  referred  to  as  a  liuear-sigmoid-linear 
NN. 


Emulator 


Figure  21.  Linear-Sigmoid-Linear  NN 


This  network  consists  of  an  input  layer  with  (m  x  1)  column  vector  x,  which  is  a  combination  of  the 
control  vector  u  and  the  state  vector  s,  and  the  input  bias  term  $i.  The  output  of  the  hidden  layer 
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vector  a  (n  x  1),  which  along  with  the  output  biaa  term  do  combined  to  produce  the  output 
vector  2  (p  X  1),  or  the  next  state  of  the  plant. 

In  order  to  simplify  the  analysis,  the  input  and  hidden  layer  vectors  wiU  be  combined  with 
the  respective  bias  terms  to  produce  a  single  vector.  Thus  the  revised  input  vector  is  the  input 
vector  X  appended  with  the  input  bias  term  6i  ([x^j^i]^)  denoted  by  x.  Similarly,  the  output  of 
the  hidden  layer  a  is  appended  with  the  output  bias  term  Og  to  produce  the  revised  hidden  layer 
vector  a  =  [a^|0o]^-  The  associated  weight  matrices  are  the  input  weight  matrix  Wj  [n  X  (m+1)] 
and  the  output  weight  matrix  Wo  [p  x  (n+l)]. 

The  derivation  of  the  backpropagation  algorithm  presented  here  is  a  variation  of  the  vanilla 
backpropagation  paradigm  used  by  Rogers  and  others  (16).  The  analysis  is  focused  on  a  vec¬ 
tor/matrix  representation  of  backpropagation.  The  output  of  the  network  can  be  represented  by 
the  equation: 


z 


Woa 


where  a  = 


and  a  =  /h(Wjx) 


and  X  = 


(11) 

(12) 

(13) 

(14) 


The  bias  term  8  in  both  the  input  and  output  layers  is  normally  set  to  unity.  For  the  remainder 
of  this  derivation,  we  will  consider  both  6i  and  8„  to  have  a  value  of  1. 

The  nonlinear  vector- valued  function  /h(-)  in  this  design  shall  be  referred  to  as  the  vector 
sigmoid  function  and  defined  for  some  arbitrary  (n  x  1)  vector  a  by: 
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(15) 


/h(a)  =  [/h(ai),  fkiai),  /fc(a„)l’’ 

=  [(l  +  e"‘)~S  (!  +  «“’ )r'  (l  +  e“-)-T  (16) 

(17) 


The  general  weight  update  equation  is  defined  as: 


W+ 


W- 


dE 

aw- 


where  E  =  -||d  -  zUl 
£ 


(18) 

(19) 


where  the  desired  output  of  the  NN  is  represented  by  the  vector  d  and  the  output  of  the  net  is 
represented  by  z. 

C.1.1  Output  Layer.  Consider  the  problem  of  minimizing  the  error  function  |||d  —  z||2 
with  respect  to  the  input  output  weight  matrix  Wo-  Begin  by  taking  the  partial  derivative  of  the 
error  function  with  respect  to  the  output  weight  matrix  W^. 


dE 

dW„ 


1  d 


2dWo 
1  d 
2dVf„ 
1  d 

2dMVo 

1  d 


l|d-zlll 


2dWo 
1 


(d-z)^(d-z) 

(d^d  -  2z^d  +  z^z) 

(d^d  -  2a^W^d  +  a^’WJ'Woa) 


^  ^  _^(_2a^’w2’d)  + — 


aw. 


■(d^d)  + 


dW„ 


aw„ 


(20) 

(21) 

(22) 

(23) 

(24) 


Since  d  is  not  a  function  of  Wo,  then  g^(d^d)  =  0.  Thus,  there  are  only  two  remaning 
terms  to  consider.  In  order  to  more  easily  analyze  the  partial  derivatives,  it  might  be  helpful  to 
restructure  the  matrix  into  a  row  vector  with  column  vectors  as  elements. 


d 

dW„ 


(«)  = 


a 


aw, 


•(«), 


Ol 


a 


(«),• 


(25) 


Examining  a  single  column  vector  gradient  where  fc  €  {1,  ■  •  • ,  n,  n  +  1},  consider 

the  last  term  in  equation  24: 


a 

awo^ 


(a^WjWoa) 


—  [(W.ij’-W.i] 


(26) 


Applying  the  product  rule  for  a  vector  gradient  (17:274),  where  a  and  b  are  vector-valued 
functions  of  the  vector  0: 


^a^(0)  b(tf)  =  (^a’’(£))  b(£)  (^b^(£))  «(»)  (27) 

If  a(£)  =  b(£),  then  the  equation  becomes: 


^a^(0)  a(£)  =  2  (^a^{£))  a(£)  (28) 

We  can  then  express  equation  26  as: 


=  2(j^(W,ar)w.i  ,29) 

=  (6<i) 
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Then  taking  the  gradient,  we  find  only  ai,  remains,  and  thus  equation  26  becomes; 


^(a^WfWoa) 


2akWok  1<  k  <n 

< 

2Woa  A:  =  n  +  1 


And  then  reconstructing  the  matrix: 


a 

aWo 


(a^WfW^a) 


[2oi Wofi  2o2Woa  •  •  •  2anWoa] 
2Woaa=^ 


Examining  the  second  term  of  the  equation  24: 


d  (  _  ra(-2a^W^d)  a(-2a^W^d)  a(-2a^W,^d)] 

awo'  ^  dwo,  dwo,  aw„,  J 

Again,  examining  a  single  vector  gradient  for  the  kth  vector: 


a 


d 


[oi  aj.--o„ 


•wr 


On+l 


]’’d 


—  [otw^,  +  02W^,  +  • . .  +  OnwJ’,  +  Jd 


Ofcd  ^  <  k  <n 
d  fe  =  n+ 1 


Placing  the  vectors  back  into  matrix  form: 


-(-2a’’w2’d)  =  -2(oidojd-o„dd] 


=  -2da* 


Combining  the  two  portions  of  the  original  equation  24: 


=  -da^  +  Woia^ 


=  -(d-Woa)a* 
5=  -(d  -  *)a^ 


C.1.2  Input  Layer.  Now  to  address  correction  of  the  input  network  weights,  Wj.  We 
begin  as  before  by  taking  the  gradient  of  the  error  function  E  =  |||d  —  zUl  with  respect  to  W,.  In 
the  same  way  as  the  output  weight  derivative,  we  arrive  at  the  foUovdng: 


And  as  before,  we  examine  the  fcth  column  of  the  gradient: 


5  ^  \  d  ,  ,  d  ,  , 
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Using  definition  ^m^Qm  =  2(^m^)Qm  (17:274),  the  last  term  in  equation  45  becomes 


-(a^’WjW.a)  =  2  WfW„/h(W<x) 


Turning  attention  to  the  second  term  in  equation  45  in  a  similar  vector  gradient  analysis: 


^(-2a^Wjd)  =  -2^(a^Wjd) 


Notice  both  terms  of  equation  45  have  the  common  factor  2(  j;^a*’)W2’.  Recombining  the  two 
terms  and  factoring: 


Focusing  attention  on  the  gradient  calculation  ^  now  analyze  the  gradient  of  the  vector 

sigmoid  function.  For  simplicity,  let  a  =  W{X. 


=  sir  [/fov.*)|i| 
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=  A(«2).-"./>i(“n)lll 

=  a;~lA(“i)»  /fc(a2),---,/h(an)110 

uWjj 

Olkiol)  g/>(a»)  ...  afr(a.)  0 

**‘i*  •»<»* 

$M2il  ...  gA(<».)  Q 


«/»(«.)  »M23)  ... 


(55) 

(56) 

(57) 

(58) 


(59) 


Examining  each  element, 


dwij^ 


d 


-(l+c-“*)-^) 


dw, 


‘i* 


-(l  +  c~“‘)“*e""‘(-l) 


dat 


dw, 


»>* 


(l  +  e"“*)"^e~“‘(l  +  e-“*) 


Mat){l  -  Mae)) 


dai 

&Wi., 


0/(1  -  ae) 


dat 
dw, 


(60) 

(61) 

(62) 

(63) 

(64) 


we  find  that 


d  , 

dWi,’^ 


®l(l  a2(l-«2)^^  "On(l-On)^^  0 


(65) 
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F 


However,  =  0  when  /  /  fc. 


Thifl  can  be  seen  when  considering  the  the  vector 


Wii 

(66) 

[Wi,Xx  +  W<,X2  +  •  •  •  +  Wi^Xm  + 

(67) 

The  /th  element  of  this  vector  is: 


at  =  +  t«>.„X2  +  •  •  •  +  Wi,^Xm  + 


(68) 


When  taking  the  derivative  with  respect  to  the  only  term  in  the  sum  that  remains  is  the  kth 
term  when  t  =  j.  Thus: 


dat 


{Xk  t  =  j 

0  t¥^j 


(69) 


The  matrix  in  equation  65  then  reduces  to  a  diagonal  matrix 


oi(l-oi)x*  0 


0 


0 


a  . 

awi/ 


0  03(1  -  02)xk 


0 


0 


(70) 


0 


0 


On(l-a„)x*  0 


=  [diag[ai (1  -  ai)xfc,  03(1  -  «a)®fc.  "  • ,  ar.(l  -  On)xfc]  |  Q„] 


(71) 

(72) 


=  [diag  (a  ©  (!„  -  a))  |  Q„)]  x» 


(73) 
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where  O  represent  the  Hadamard  or  arr^r  product  (10:45).  Inserting  this  result  into  equation  53: 


dE 

dWi^ 


-diag  (a  ©  (1„  -  a))  |  Q„)xfcWf  (d  -  i) 
-diag  (a  ©  (1„  -  a))  |  0„)Wf  (d  -  s)ik 


Combining  all  the  vectors  into  the  original  matrix  in  equation  45: 


(74) 

(75) 

(76) 


dE 

dWi 


-(dio<7(a  ©  (1„  -  a)l  I  Q„)W2’(d  -  *)xi 
-(dios[a  ©  (1„  -  a)l  I  Q„)Wr(d  -  *)x, 

-(<i*oj,(a  ©  (1„  -  a)]  I  Q„)W2’(d  -  z)x„ 
-(dia<7(a©(l„-a)j|Q„)W2’(d-s) 


=  -  [diag  (a  ©  (i„  -  a))  |Q„|  Wj* (d  -  *)[xi  xj  •  •  •  x„  1] 
=  -  [diag  (a  ©  (1„  -  a))  |Q„j  Wj (d  -  z)i^ 


(77) 


(78) 

(79) 

(80) 


C.l.S  Summary. 
neural  network  is: 


The  equation  for  forward  propagation  through  the  linear-sigmoid-linear 


W„a 

(81) 

where  a  =  J jj 

(82) 

and  a  =  /h(WiX) 

(83) 

(84) 
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And  the  backpropagation  weight  update  equations  are: 


WJ 

wt 


wj-t, 

where 


dE 
dYTo 
dE 


Wr-f, 

where 


dWc 

dE 


—  —  -(d  -  *)a 


dvfi 

dE 


dVf 


-  =  -(diaff(a©(l„ 


a))|Q„]w;^(d-*)i*’ 


(85) 

(86) 

(87) 

(88) 


C.2  Controller 


The  controller  network  in  this  design  is  also  a  linear-sigmoid-linear  neural  network.  The 
output  of  this  network  is  the  control  vector  u.  This  is  combined  with  the  state  vector  s  to  produce 
the  input  for  the  emulator  (Figure  22). 


'-k+1 


Emulator 


Controller 


Figure  22.  Emulator  and  ControUer 
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C.2.1  Equivalent  Error.  The  backpropagatioa  derivation  for  the  controller  network  is 
identical  to  the  emulator,  with  the  exception  of  the  origin  of  the  error.  In  the  case  of  the  emulator, 
there  is  a  specific  desired  response  to  be  compared  to  the  output  of  the  net.  In  the  controller, 
however,  there  is  no  direct  measure  of  error.  In  this  instance,  the  concept  of  equivalent  error  is  used. 
Examining  a  slightly  different  representation  of  the  weight  update  equation  used  by  Nguyen  (13): 


W+  =  W-  +  2p4v’’  (89) 


where  6  is  the  equivalent  error  vector  defined  by 


(d-x)/;(W„a) 

(90) 

/;(W„a)Wftf, 

(91) 

for  the  output  and  hidden  layers  respectively  and  v  is  the  output  of  the  previous  layer.  Thus  we 
can  alternatively  represent  the  weight  update  equations  derived  in  section  C.l  as; 


(92) 

wt 

(93) 

Again,  6^  and  ^  represent  the  equivalent  errors  at  the  output  and  hidden  nodes  respectively  This 
is  identical  to  the  derivation  in  section  1.  Note  that  the  equivalent  error  at  the  output  layer  of  the 
emulator  is: 
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L.  =  (d-*) 

(94) 

since  /^(Woa)  =  1 

(95) 

and  the  equivalent  error  at  the  hidden  layer  is: 

=  /aW<x)Wjd,. 

(96) 

=  (diag(a  ©  (1„  -  a)|Q„)W;^(d  -  *) 

(97) 

where  /h(Wix)  =  ldiag(a  0  (1„  -  a))|Q„] 

(98) 

C.2.2  Controller  Weights.  In  order  to  update  the  controller  weights,  the  final  state  error 
at  the  emulator  output  is  backpropagated  through  the  emulator  net  without  updating  the  emulator 
weights.  At  the  output  to  each  layer,  there  is  an  equivalent  error  which  is  used  by  the  preceding 
layer  as  the  error. 

In  the  output  layer  of  the  emulator  net,  the  equivalent  error  is  simply  the  actual  error.  The 
hidden  lay  prior  to  this,  the  error  is  distributed  over  each  output  of  the  hidden  layer.  Since  the 
input  to  the  emulator  NN,  x,  consists  of  both  the  state  vector  s  and  the  control  vector  u,  the 
equivalent  error  will  also  consists  of  two  components,  6,  and  Thus,  the  equivalent  error  at  the 
output  of  the  controller  net  would  be  the  equivalent  error  for  the  control  vector  u  at  the  input  to 
the  emulator  net. 


L  =  6.. 


(99) 

(100) 
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The  subscript  u  in  Equation  100  indicates  those  elements  of  the  vector  corresponding  to  the 
control  vector  u.  Applying  the  same  approach  used  in  the  emulator  NN,  the  equivalent  error  at 
the  hidden  layer  of  the  controller  NN  is: 

h,  =  (101) 

=  (dtog(a.©(l„-a.)|0„)W^„^6o.  (102) 

C.2.3  Summary.  The  controller  network  update  equations  are: 


wx 

(103) 

(104) 

6^^  =  {diagia,  ©  (1„  -  a.)|Q„)W;;tf,. 

(105) 

^i.  =  (d  -  z) 

(106) 

= 

(107) 

h,  =  {diagi^c  O  {hi  -  ac)|Q„)W-"'^^ 

(108) 

C.3  Back  Propagation  Through  Time 

In  the  case  of  BPTT,  this  process  of  equivalent  error  can  continue  throughout  the  previous 
time  steps  with  a  slight  modification.  Recall  in  obtaining  Equation  100  there  also  is  a  component 
of  the  equivalent  error  corresponding  to  the  state  input  vector  z.  This  is  the  same  vector  that  is 
simultaneously  input  to  the  controller  NN. 

The  emulator  output  of  the  previous  state  is  input  to  both  the  emulator  and  control  NNs 
of  the  next  state.  Each  output  node  of  the  emulator  is  connected  to  an  input  node  of  both  the 
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Zd 


Figure  23.  Training  the  Controller  (C  =  Controller,  E  =  Emulator)  (13:20) 

emulator  and  controller  of  the  next  state.  If  we  examine  the  backpropagation  equations  as  applied 
to  a  single  node,  we  find  the  equivalent  error  is  the  sum  of  the  equivalent  errors 


t=i 


Since  there  are  no  weights  or  nonlinearities  between  states,  this  reduces  to: 


n 

»=i 


(109) 

(110) 


(111) 
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Thus,  the  error  vector  at  the  output  of  the  emulator  in  the  (k  —  l)th  state  u  the  sum  of 

the  equivalent  errors  for  the  position  vector  (s)  at  the  input  of  the  emulator  and  controller 

)  in  the  ibth  state. 

»c(»)  ' 


(113) 


Then  it  simply  becomes  a  matter  of  backpropagating  this  error  through  the  (k  —  l)th  state  and 
continuing  the  process  until  reaching  the  first  state. 
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Appendix  D.  FAME 


This  appendix  includes  documentation  on  the  vairious  hardware  and  software  modifications 
made  in  the  course  of  this  research,  changes  to  the  Report  on  the  Fast  Adaptive  Maneuvering 
Experiment  (FAME)  (Section  D.3.1),  and  the  user’s  guide  for  the  AFIT  FAME  apparatus  (Sec¬ 
tion  D.4).  Prior  to  attempting  any  experimentation  using  FAME,  it  is  highly  recommended  the 
experimenter  read  the  entire  contents  of  the  original  report  and  as  well  as  all  updates.  Current  soft¬ 
ware  code  as  well  as  various  documents  are  available  through  anonymous  FTP  to  “fame.gmu.edu” 
under  the  directory  “pub”.  Section  D.2  includes  a  reprint  of  the  various  FAME  documents  available 
through  FTP.  The  primary  point  of  contact  at  George  Mason  University  is  Darrell  Duane,  E-Mail 
dduane@mason  1  .gmu.edu . 

D.l  Summary  of  Updates 

D.1.1  Software.  The  FAME  apparatus  was  delivered  with  the  software  FAMEPC,  version 
3.0.  Since  then,  versions  4.0  through  6.0  have  been  made  available.  Also  available  is  a  C-l-1- 
Windows  version  of  the  software  called  TEMPOl.  A  version  of  TEMPOl  for  MS-DOS  is  also  in 
production.  In  this  research,  FAMEPC,  version  6.0  was  used  with  some  minor  modifications.  A 
listing  of  this  software  can  be  found  in  Appendix  A 

Minor  changes  to  version  6.0  of  the  software  included  changing  the  directory  paths  of  the 
header  files  “pcdef.h”  and  “famedef.h”.  A  small  section  of  code  was  changed  to  select  of  COM  1 
instead  of  COM  2  as  the  communications  port  interface  to  the  MCU.  Finally,  the  menu  display  was 
changed  to  reflect  the  correct  software  version  and  to  correct  a  spelling  error. 

A  change  was  also  made  in  the  timing  function  “DelayUntil()”  in  “ControlLoop().”.  This 
function  caused  intermittent  program  lockup  while  attempting  manually  control  the  FAME  heli¬ 
copter.  This  function  was  replaced  with  the  C-standard  function  “delay (10)”,  which  produced  a 
time  delay  of  10  milliseconds.  Unfortunately,  this  causes  inaccurate  timing  data  to  be  recorded 
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in  “filel.trn.”  However,  the  data  points  are  still  recorded  at  even  intervals  of  approximately  25 
milliseconds. 

It  is  not  mentioned  in  any  of  the  FAME  documentation,  but  it  is  abo  necessary  to  include  a 
hie  called  “generic.cal”  in  the  same  directory  as  FAMEPC.EXE.  The  program  will  run  without  it, 
but  it  will  not  report  the  state  variables. 

D.1.2  Hardware.  A  number  of  changes  to  the  FAME  hardware  were  made  in  the  course 
of  this  research.  Some  were  at  the  direction  of  the  FAME  developers  at  GMU  while  others  were 
created  out  of  necessity  specific  to  this  research. 

D.1.3  Directed  Changes.  Changes  directed  by  the  FAME  developers  are  fully  documented 
in  Section  D.2. 

D.  1.3.1  Local  Changes.  An  additional  hardware  modification  was  necessary  to 
correct  a  defect  in  the  apparatus.  The  aileron  servo  was  not  operational  duv  to  an  open  circuit  in 
one  of  the  leads.  Since  it  turned  out  this  lead  was  common  to  all  the  servos,  the  correction  was 
to  install  a  jumper  from  an  adjacent  connector.  The  jumper  is  between  connectors  1  and  2  on  the 
servo  block. 

Quick  connects  were  also  installed  to  allow  easy  removal  of  the  helicopter  from  the  test  stand. 
The  connectors  are  standard  for  Radio  Controlled  use  and  can  be  easily  connected  to  a  standard 
helicopter  radio  receiver. 

The  Halt  Whisper  helicopter  is  secured  to  the  stand  using  plastic  tie  wraps.  Again,  this 
permits  easy  removal  of  the  helicopter  by  simply  cutting  the  ties  wraps.  These  tie  wraps  are 
inexpensive  an  easily  replaced. 

It  was  also  necessary  to  modify  the  stand  to  stabilize  the  helicopter  during  take  off  and 
landing.  As  delivered,  the  helicopter  remained  suspended  firom  the  training  platform  during  the 
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take-off  run-up.  The  engine  torque  would  cause  the  helicopter  to  yaw  wildly  until  the  tail  rotor 
developed  enough  speed  to  generate  yaw  control.  Similar  problems  resulted  on  landing.  The 
modification  raises  the  red  direction  of  flight  (DOF)  collar  to  support  the  landing  skids  when  the 
apparatus  is  resting  on  the  floor.  As  the  helicopter  begins  to  rise,  the  platform  lowers,  allowing 
freedom  of  movement  about  all  axes.  Drawings  of  this  modification  can  be  found  in  Section  D.3.1. 

D.2  Fast  Adaptive  Maneuvering  Experiment  File  Repository 

The  following  section  is  a  reprint  of  the  various  FAME  documents  available  by  anonymous 
FTP  to  fame.gmu.edu.  Footnoted  comments  are  provided  to  document  the  changes  in  the  AFIT 
FAME  apparatus  and  to  help  further  clarify  the  updates. 

D.2.1  GYROMOD.  W51:  Hardware  Modification  to  facilitate  pulse  width  measurement  from 
Gyro.  In  order  to  enable  the  software  to  measure  the  length  of  the  pulse  width  from  the  Gyro 
which  provides  an  indication  of  the  rate  of  rotation  of  the  helicopter  (Yaw  Dot),  a  wire  must  be 
replaced  on  the  servo  connector  block.  The  quick  ties  which  secure  the  bulk  of  the  ribbon  cable 
to  the  aluminum  extension  should  be  clipped.  The  ribbon  cable  follows  the  resistor  color  code  for 
the  units  digit  of  the  pin  number,  thus  pin  #28  is  a  gray  wire.  It  is  this  wire  which  should  be 
unsoldered  from  servo  block  position  #0,  and  the  remaining  uninsulated  wire  should  be  clipped. 

The  new  wire  that  is  to  be  connected  at  the  servo  block  position  #0  is  pin  #32,  a  red  wire, 
and  can  be  found  by  looking  4  wires  above  the  unsoldered  gray  wire.  It  is  not  necessary  to  place 
the  new  wire  into  the  sheath  where  the  remmning  servo  block  wires  Me  protected.  However,  a  piece 
of  heat  shrink  tubing  is  provided  to  insulate  at  the  solder  joint.  Also,  quick  ties  are  provided  to 
secure  the  ribbon  cable  to  the  aluminum  extension.  This  completes  the  hardware  modification  to 
gather  data  from  the  Gyro.^ 

^These  ch2uiges  ate  already  installed  on  the  AFIT  FAME  apparatus. 
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D.2.i  README:  Faat  Adaptive  Maneuvering  Experiment  File  Expository  . 


The  files 


for  all  previous  version  of  the  FAME  project  are  available  individually  or  as  a  set  in  various  files 
famefiJO.tar.Z  in  the  directory  verSJ). 

To  access  these  files,  FTP  them  in  the  binary  mode  (type  binary  at  the  FTP  prompt),  use 
the  uncompress  command  to  expand  the  file,  (type  uncompress  fameSjO.tar.Z),  untar  the  files  (tar 
xfv  famebJO.tar),  and  the  files  will  be  avsdlable  on  your  unix  machine.^ 

Also,  the  FAME  report  is  available  in  postscript  format  in  the  report  directory. 

D.2.3  WJREAD.TXT.  FUe  name:  V/JREAD.TXT 
Created:  3/5/92 
Updated:  3/26/92 

This  text  file  gives  instructions  on  how  to  upload  WRITEJMP.O  to  the  Motorola  MC68HC11EVB. 
It  is  assumed  that  the  user  is  familiar  with  Kermit  and/or  PROCOMM  or  some  other  terminal 
emulation  program. 

WRITEJMP.O  programs  the  first  three  memory  locations  in  EEPROM  to  jump  to  the  start 
of  FAMEMAIN.  This  jump  will  occur  if  jumper  J4  on  the  EV6  is  connected  between  pins  2-3.  If 
J4  is  connected  between  pins  1-2,  then  the  Buffalo  monitor  will  start  when  the  restart  button  is 
pushed. 

If  WRITEJMP.O  has  been  run  on  the  EVB,  then  jumper  J4  on  the  board  must  be  moved 
to  the  1-2  position  so  that  the  Buffalo  monitor  will  run,  and  then  switched  back  to  2-3  after 
FAMEMAIN.O  is  uploaded. 

Assuming  Kermit: 

1.  Connect  the  PC  without  a  null  modem  to  the  bottom  DB-25  connector  on  the  EVB.  9600 

Baud,  No  parity,  1  Stop  bit. 

^The  same  piocednte  applies  to  any  of  the  tarred  file*  available  from  the  FAME  repository. 
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2.  Start  Kermit.  Connect.  If  no  Buffalo  prompt  (>),  push  reset  button  on  EVB  (located  below 
tne  4  screw  contact  power  connector). 

3.  At  the  “>”  prompt,  tjrpe  load  t  followed  by  a  carriage  return. 

4.  Escape  back  to  Kermit  by  pressing  the  keys  control-]  simultaneously  followed  by  the  single 
letter  c 

5.  At  the  kermit  prompt,  type  transmit  WRITEJNP.O  \0.  The  \0  is  important  as  it  disables 
some  handshaking. 

6.  It  takes  several  minutes  to  download. 

7.  When  the  Kermit  prompt  appears,  tjrpe  c  to  connect  to  the  EVB  again. 

8.  Type  the  keys  control-A  simultaneously  followed  by  a  carriage  return.  The  “>”  prompt 
should  reappear. 

9.  One  must  now  either  type  g  cOOO  to  cause  the  WRITEJMP  program  to  run.  It  only  takes  a 
few  seconds. 

10.  If  there  is  no  prompt  after  running  WRITEJMP,  push  the  restart  button  and  determine 
whether  the  automatic  startup  is  enabled  by  typing,  at  the  Buffalo  prompt,  >,  md  b600 
followed  by  a  carriage  return.  Buffalo  should  respond  with  several  lines  containing  the  contents 
of  the  memory  starting  at  location  OxBOOO.  The  first  line  should  contain  7E  18  00.  This  can 
only  be  programmed  by  running  the  writejmp.O  program  since  it  is  in  EEPROM. 

The  procedure  in  PROCOMM  is  similar  except  the  file  is  uploaded  using  the  page-up  key, 
ASCII  transfer  (menu  number  7),  and  then  typing  the  filename.  When  finished,  the  Buffalo  prompt 
will  appear  and  there  is  no  need  to  type  control-A.  On  some  machines,  PROCOMM  is  terribly  slow 
in  uploading  and  Kermit  is  much  faster.’ 

*A  temindei  that  all  commaaication  ocean  at  19200  band  onng  the  lower  DB-25  connector.  At  this  speed,  the 
procedure  using  PROCOMM  and  ASCII  transfer  proved  to  be  quite  effective,  especially  when  using  a  386-based 
machine,  l^ansfen  normally  took  about  30-60  seconds. 
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D.2.4  FMREAD.  TXT.  George  Maeon  UniTeisity,  Department  of  Electrical  and  Com¬ 


puter  Engineering,  4400  University  Drive,  FUrfax,  VA  22030 
FUe  name:  FMREAD.TXT 
Created:  3/5/92 
Updated:  3/26/92 

This  text  file  gives  instructions  on  how  to  upload  FAMEMAIN.O  to  the  Motorola  MC68HC11EVB. 
It  is  assumed  that  the  user  is  familiar  with  Kermit  and/or  PROCOMM  or  some  other  terminal 
emulation  program. 

If  WRITEJMP.O  has  been  run  on  the  EVB,  then  jumper  J4  on  the  board  must  be  moved 
to  the  1-2  position  so  that  the  Buffalo  monitor  will  run,  and  then  switched  back  to  2-3  after 
FAMEMAIN.O  is  uploaded. 

Assuming  Kermit: 

1.  Connect  the  PC  without  a  null  modem  to  the  bottom  DB-25  connector  on  the  EVB.  9600 
Baud,  No  parity,  1  Stop  bit. 

2.  Start  Kermit.  Connect.  If  no  Buffalo  prompt  (>),  push  reset  button  on  EVB  (located  below 
the  4  screw  contact  power  connector). 

3.  At  the  ">”  prompt,  t3rpe  load  t  followed  by  a  carriage  return. 

4.  Escape  back  to  Kermit  by  pressing  the  keys  control-]  simultaneously  followed  by  the  single 
letter  <■ 

5.  At  the  kermit  promot,  type  transmit  FAMEMAIN.O  \0.  The  \0  is  important  as  it  disables 
some  handshaking. 

6.  It  takes  several  minutes  to  download  the  approximately  550  lines  of  Motorola  S-record  exe¬ 
cutable  file. 

7.  When  the  Kermit  prompt  appears,  type  c  to  connect  to  the  EVB  again. 
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8.  Type  the  keys  control-i  simultaneously  followed  by  a  carriage  return.  The  prompt 

should  reappear. 

9.  One  can  now  either  t3rpe  g  cOOO  or  replace  jumper  J4  and  push  the  restart  button  on  the 

EVB.  Either  action  will  start  the  famemain  program  which  has  a  starting  address  of  0x1800. 

To  determine  whether  the  automatic  startup  is  enabled  on  your  EVB,  type,  at  the  Buffalo 
prompt,  >,  md  b600  followed  by  a  carriage  return 

Buffalo  should  respond  with  several  lines  containing  the  contents  of  the  memory  starting  at 
location  OxBOOO.  The  first  line  should  contain  7E  18  00. 

This  can  only  be  programmed  by  running  the  writejmp.O  program  since  it  is  in  EEPROM.  If 
automatic  startup  is  not  enabled  on  your  EVB,  read  the  file  wjread.doc  for  information  on  running 
the  program  writejmp.O  on  your  EVB. 

The  procedure  in  PEOCOMM  is  similar  except  the  file  is  uploaded  using  the  page-up  key, 
ASCII  transfer  (menu  number  7),  and  then  typing  the  filename.  When  finished,  the  Buffalo  prompt 
will  appear  and  there  is  no  need  to  type  control-A.  On  some  machines,  PEOCOMM  is  terribly  slow 
in  uploading  and  Kermit  is  much  faster. 

Eemember  that  FAMEMAIN  operates  through  the  upper  DB-25  connector  at  9600  baud,  no 
parity,  1  stop  bit,  using  a  nuU  modem  and  expects  to  talk  to  FAMEPC.EXE.* 

D.2.5  FAME  Software  Release  6.0,  November  20,  1992. 

D.2.5.1  Modifications*.  FAMEPC  no  longer  controls  the  helicopter  via  the  PC’s 
keyboard,  but  rather  via  the  game  port  using  Joysticks  provided  by  the  Skylark  E/C  Helicopter 
Flight  Simulator  software  package.  FAMEPC  also  can  be  triggered  to  collect  input/output  data 

*Again  note,  after  the  baud  rate  modification,  FAMEMAIN  now  operates  at  19200  band,  no  parity,  1  stop  bit, 
without  a  null  modem  through  the  lower  DB-25  connector. 

*This  modification  has  been  installed  on  the  AFIT  FAME  apparatus. 
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for  flight  of  the  helicopter.  It  is  expected  to  retam  the  keyboard  control  of  the  helicopter  with  the 
next  version  of  software. 

Communications  now  occurs  at  19.2  kBaud  over  the  ACIA  port,  rather  than  the  SCI  port. 
This  allows  for  measurement  of  the  helicopter  position  and  control  based  upon  this  position  at  a 
fixed  rate  of  50  Hs.  This  upgrade  requires  a  few  minor  hardware  modifications. 

1.  Communications  to  the  EVB  from  the  PC  now  takes  place  only  using  the  bottom  port(when 
looking  at  the  board  upside  down,  with  the  helicopter  up  side  up),  without  a  null-modem. 
After  downloading  FAMEMAIN.O  to  the  EVB  using  kermit  or  some  other  terminal  program, 
shutting  ofif  power  to  the  EVB,  moving  J4  back  to  its  original  position,  the  serial  cable  will 
remsdn  attached  to  the  bottom  DB-25  of  the  EVB. 

2.  In  order  to  communicate  at  19.2  kBaud  over  the  ACIA,  a  jumper  must  be  made  on  the 
board.  This  jumper  must  go  from  pin  9  of  U13  to  any  one  of  the  pins  on  the  left  row  of 
pins  on  J5.  Also,  the  blue  jumper  must  be  removed  from  this  row  of  pins.  Note  that  after 
this  modification  is  made,  all  communications  (including  the  downloading  of  new  software) 
between  the  PC  and  the  EVB  over  the  ACIA  must  be  performed  at  19.2  kBaud. 

Full  control  of  the  servos  is  now  available  with  each  control  string.  Incremental  control  is  no 
longer  being  used  as  it  was  in  Version  5. 

There  is  no  longer  a  protocol  analyzer  available  for  this  format  of  communication. 

D.2.6  Release  5.0,  August  25,  1992.'’ 

D. 2.6.1  Modifications.  It  appears  that  all  jittering  problems  have  been  alleviated. 
The  interrupt  for  measuring  the  response  from  the  Gyro  seems  to  have  caused  jittering  in  the 
previous  versions  when  it  would  be  synchronized  with  one  of  the  pulse  widths  sent  to  control  a 

^The  foUowing  docamentation  on  releases  2.1  thiongli  5.0,  while  not  current  is  still  nseihl  since  many  of  the 
features  are  incorporated  into  version  6.0. 
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servo.  The  pulse  widths  are  now  generated  in  such  a  way  that  the  response  from  the  servo  (which 
triggers  the  input  capture)  does  not  interfere  with  the  output  compares. 

Jitters  caused  by  the  receive  interrupt  have  also  been  alleviated.  The  receive  interrupt  has 
been  disabled,  and  transmissions  &om  the  PC  are  monitored  directly  from  the  foreground.  This  is 
possible  since  the  servo  control  information  has  been  reduced  to  one  byte.  Requests  to  increase  or 
decrease  each  servo  by  one  out  of  250  different  settings  are  sent  using  a  ternary  code.  With  five 
servos,  this  system  uses  the  8  bits  to  code  0  through  242  (3‘  =  243)  to  control  the  servos.  The 
Elevator  occupies  the  LSB,  followed  by  the  Aileron,  Throttle,  Collective,  and  the  Rudder  is  in  the 
MSB.  Hence  the  format  shown  in  Table  1. 


Table  1.  Servo  Control  Format 


Control 

Macro 

Code 

Control 

Macro 

Code 

Decrease  All 

ALL_DEC 

0 

Increase  All 

ALLJNC 

242 

No  Change 

ALLJ^O.CHANGE 

121 

Dec.  Elevator 

ELEVATORJ)EC 

120 

Inc.  Elevator 

ELEVATOIUNC 

122 

Dec.  Aileron 

AILERONJIEC 

118 

Inc.  Aileron 

AILERONJNC 

124 

Dec.  Throttle 

THROTTLEJIEC 

112 

Inc.  Throttle 

THROTTLEJNC 

130 

Dec.  Collective 

COLLECTIVE  J)EC 

94 

Inc.  Collective 

COLLECTIVE  JNC 

148 

Dec.  Rudder 

RUDDER-DEC 

40 

Inc.  Rudder 

RUDDERJNC 

202 

Further,  the  numbers  above  242  have  been  allocated  to  perform  the  following  tasks  shown  in 
Table  2. 


Table  2.  Data  Format 


Control 

Macro 

Code 

Stop  Throttle 

REQ.DEFAULT.THROTTLE 

243 

Set  all  Servo  Values  to  Default 

REQ_DEFAULTJ5ER.VALS 

244 

Dummy  Value  -  EVB  Internal  Use 

DUMMY 

249 

Send  Potentiometer  Values 

POTJIEQ 

254 

Send  Servo  Values/Settings 

SER-REQ 

255 

The  EVB  now  acknowledges  all  servo  control  bytes  (0  -  242)  with  the  potentiometer  values. 
The  potentiometer  values  consist  of  9  bytes:  6  for  the  6  potentiometers,  2  for  the  yaw  gyro  and  1 
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for  the  checksum.  The  Start,  Command,  and  Stop  characters  are  no  longer  included.  With  this 
change  comes  a  change  in  the  sequence  of  error  measurement.  Instead  of  the  sequence  listed  under 
the  revision  notes  for  version  4.0,  below,  the  sequence  is  shown  in  Table  3. 


Table  3.  Control  Sequence 


{■1 

PC: 

EVB: 

PC: 

PC: 

PC: 

PC: 

i^n 

11^1 

Send 

copy 

Calc 

Calc 

Calc 

hi' 

servo 

Pot 

old 

new 

error 

servo 

^Bl' 

IHIII 

values 

values 

error 

error 

dot 

values 

BHI 

{■1 

vector 

vector 

vector 

^Bl 

The  new  rate  of  this  sequence  is  66  Hz. 


D.2.6.2  FAMEPC. 


Dynamic  Control.  FAMEPC  now  Dynamically  Controls  with  a  Proportional, 
Integral,  Double  Integral  controller.  While  in  the  Dynamic  Control  mode  and  after  choosing  a 
particular  servo  for  which  to  vary  the  transfer  coefficients,  the  keyboard  is  laid  out  as  shown  in 
Table  4. 


Table  4.  Keyboard  Layout 


Info: 

MSM5M 

(F2) 

(F3) 

mmm 

BUtJB 

msam 

(F7) 

Double  Int 

Inc: 

ma 

mam 

Mssm 

(4)Pitch 

(6)Yaw 

(7)  Yaw  Gyro 

^£1 

Emm 

mmm 

(T)RoU 

(U)Yaw  Gyro 

Integral 

1^1 

Hia 

(D)Z 

■yumi 

(J)Yaw  Gyro 

wsat 

wimsM 

(B)RoU 

(M)Yaw  Gyro 

Proportional 

Ksa 

wsm 

mimm 

mmm 

(j)Yaw  Gyro 

Dec: 

■@£1 

■sa 

msm 

(v)Pitch 

(b)Roll 

(P)otentiometer  Data  (OPosition  Data  (-)Error  Vector 
(8)Di8play  PC  Servo  Vais  (9)Di8play  EVB  Servo  Vais  (O)Equalize 

Gyro  Offset:  (F8)Display  (F9)Decrement  (FlO)Increment 
(I)  quit  var]ring  values  for  this  servo 

The  error  vector  can  now  be  displayed  real  time  by  typing  the  (-)minus  dash  key.  Also,  there 
are  some  cases  where  the  servo  values  maintained  by  the  PC  become  different  from  those  of  the 
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EVB.  (8)  Displays  the  PC’s  servo  values,  (9)  request  the  servo  values  from  the  EVB  and  displays 
them,  and  (0)  Requests  values  from  the  EVB  and  sets  the  PC’s  values  equal  to  these  requested 
values. 

When  setting  the  Transfer  Coefficients  for  the  Yaw  Control,  it  is  often  helpful  to  be  able  to 
modify  the  Gyro  Offset  value,  since  it  is  this  value  that  serves  as  the  DC  offset  of  the  yaw  from  the 
desired  value.  It  has  been  found  that  the  dynamic  control  feature  is  able  to  keep  a  specified  yaw 
setting;  however,  this  yaw  setting  will  always  have  a  non-zero  error  as  revealed  using  the  (-)  key. 
This  error  can  be  set  to  zero  by  adjusting  the  Gyro  Offset  value.  Thus  (F8)  displays  the  current 
setting,  (F9)  decreases  and  (FIO)  increases  the  Gyro  Offset  value. 

At  George  Mason  University,  we  have  achieved  good  control  of  the  Pitch,  Roll  &  Yaw  axis 
and  are  currently  searching  for  transfer  coefficients  to  control  the  elevation.  The  GENERIC.COE 
file  that  is  a  part  of  this  package  reflects  these  attempts.  After  the  elevation  is  stabilized,  I  expect 
we  will  work  on  the  X  &  Y  axes. 

The  control  routines  are  in  the  function  DynamicControl(),  and  are  taken  from  Discrete-Time 
Control  Systems  by  Katsuhiko  Ogata,  1987,  pp.  200-204.  The  nature  of  the  communications  link 
between  the  PC  &  EVB  requires  that  control  be  in  the  velocity  form,  that  is,  instead  of  directly 
calculating  values  for  the  servo  settings,  values  are  calculated  to  increment  or  decrement  the  servo 
settings. 

Control  of  the  helicopter  was  first  attempted  with  a  discrete  PID  control,  but  we  were  unable 
to  achieve  reliable  control  of  the  pitch  and  roll  axes.  Next,  we  attempted  control  using  a  P-I- 
II  controller,  and  were  able  to  achieve  stability.  The  P-I-II  control  was  formed  by  applying  the 
positional  form  of  control  to  the  helicopter 

In  PID  control,  the  positional  form(direct  control)  is 
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«(*) 

e(e) 


Kie(t}dt  +  K,eit)  +  Kd 


dt 


desired  position  —  actual  position  vector 


The  discrete  version  of  this  is 


u(t)  =  Ki 


(e(0)  +  e(T))  .  (e(r)-t-e(2r)) 


(e(k-l) 


+  «(*))' 


Kpe(k)  +  Kje(k)  -  e(k  -  1) 


For  the  integral  term,  the  program  keeps  eiror  vectors  for  four  terms  into  the  past.  Also,  the 
divide  by  two  for  each  pair  of  error  vectors  is  not  included  since  this  would  merely  scale  the  Ki 
coefficient.  Because  we  are  applying  the  positional  form  to  a  problem  that  requires  a  velocity 
form,  our  control  function  looks  like; 


u(f)  =  Kiile(k  -  4)  +  e(fc  -  3)  +  e(fe  -  3)  +  e(fc  -  2)  +  e(ik  -  2)  +  e(k  -  1)  +  e(fe  -  1)  +  e{k)]  + 
Kieik)  +  Kpe(k)  -  e(k  -  1) 

D.2.6.3  FAMEMAIN.  All  calibration  of  potentiometer  values  now  takes  place  on  the  PC.  The 
commands  to  request  Position  values  directly  from  the  EVB  have  been  removed,  since  this  is  a 
time  consuming  process,  and  it  is  difficult  to  create  the  calibration  coefficients  on  the  EVB.  This 
software  release  does  not  contain  the  code  for  FAMECAL,  which  is  now  obsolete.  Also,  the  code 
in  the  file  FAMEINI2.C  has  been  copied  into  FAMEINIT.c  since  it  is  no  longer  necessatry  to 
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distinguish  between  initialization  functions  required  for  both  FAMEMAIN  &  FAMECAL,  and 
those  that  are  only  used  in  FAMEMAIN. 

D.2.6.4  Protocol  Analyzer.  In  order  to  view  the  commands  being  sent  to  the  EVB  real  time,  a 
‘protocol  analyzer,’  PROTOAN.EXE  was  developed.  The  RX  tc  Ground  lines  of  a  second  PC’s 
serial  port  are  connected  to  the  TX  &  Ground  lines  (respectively)  of  the  PC  running  FAMEPC. 
This  program  decodes  the  byte  sent  to  the  EVB  and  displa3rs  5  columns  of  -1,  0,  or  1  to  indicate 
the  servo  controls  sent.  They  are  in  the  same  order  as  listed  above:  Elevator,  Aileron,  Throttle, 
Collective,  Rudder. 

D.2.7  Release  4.0,  July  20,  1992. 

D.2.7.1  Modificaiiona.  This  version  release  marks  a  significant  change  in  the  FAME  software, 
both  structurally  and  in  the  features  offered.  There  have  been  complaints  and  we  have 
experienced  ‘jittering’  in  the  servos  which  seems  to  be  caused  by  the  HC  11.  We  hypothesized 
that  this  was  caused  by  interrupts  for  servo  control  being  unable  to  be  triggered  because 
interrupts  for  communication  were  active.  Hence,  we  have  moved  the  non-time  critical 
communications  processing  code  from  the  background  (from  the  ISRs)  to  the  foreground  (to  the 
main()  function)  where  it  can  get  interrupted. 

This  has  solved  some  of  the  jittering  problem;  however,  there  are  still  instances  of  gyros  jittering. 
For  instance,  our  Aileron  jitters  even  when  no  communications  is  taking  place.  We  have  some 
ideas  as  to  the  resolution  of  this  problem  and  will  announce  another  software  release  when  we 
resolve  it. 

Another  modification  made  to  reduce  jittering  and  reduce  the  amount  of  time  spent  controlling 
the  Helicopter  was  the  reduction  in  the  size  of  the  Servo  Values  String.  Previously,  this  string 
used  two  b3rtes  for  each  servo  value  transmitted  to  the  HC  11;  this  has  been  reduced  to  one  byte 
per  servo.  Hence,  the  Servo  Value  String  uses  9  instead  of  14  bytes. 
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D. 2.7.2  FAMEPC.  Code  has  been  developed  for  implementing  a  PD  controller  for  the 
Helicopter.  Upon  pressing  the  tilde  (")  key  while  in  the  Keyboard  Servo  Values  mode,  FAMEPC 
begins  by  establishing  a  vector  describing  the  desired  position  of  the  helicopter.  The  program 
measures  the  present  position  of  the  helicopter  by  sending  out  a  potentiometer  value  request  and 
converting  it  in  into  a  Cartesian  position  based  on  its  Calibration  CoefBcients.  The  measurements 
of  X,  Y,  Z,  &  Yaw  from  this  request  become  a  part  of  the  vector  of  desired  values.  Entries  in  this 
vector  for  Pitch,  Roll  b.  the  Yaw  Gyro  are  set  to  0,  since  it  is  desired  to  have  the  Helicopter  flying 
balanced  and  with  a  non-existent  Yaw  rotation  rate. 

Having  established  a  desired  position  vector  for  the  helicopter,  FAMEPC  continues  by  repetitively 
sending  potentiometer  value  requests.  These  potentiometer  requests  are  also  converted  into  a 
Cartesian  position  b  gyro  vector  by  FAMEPC,  and  are  then  used  to  establish  an  error  and  rate  of 
error  (error  dot)  vector.  The  error  values  are  found  by  measuring  the  difference  between  the 
desired  position  vector  b  the  actual  position  vector.  The  error  dot  vector  is  calculated  after  every 
second  potentiometer  request  by  finding  the  difference  between  the  previous  two  error  vectors. 

The  potentiometer  request  that  occurs  after  the  error  dot  vector  is  calculated,  that  is,  the  first  of 
the  set  of  two  potentiometer  requests,  also  contains  servo  control  values.  These  servo  control 
values  are  calculated  by  updating  the  previous  servo  control  values  with  changes  calculated  from 
a  matrix  that  is  multiplied  by  the  error  &  error  dot  vectors.  Valid  values  for  this  matrix  are  still 
being  measured  by  trial  and  error  at  George  Mason  University. 

This  transfer  matrix  can  be  edited  in  a  variety  of  manners.  From  the  main  menu,  an  option  is 
avmlable  to  directly  edit  it.  Also  from  this  menu,  one  can  edit  real  time  change  values  for  each  of 
the  coefficients.  These  change  values  are  amount  the  coefficient  will  change  when  a  particular  key 
is  pressed  during  real  time  control  operations.  Only  the  coefficients  which  constitute  inputs  to  one 
servo  can  be  varied  at  any  given  instant. 
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While  real  time  control  is  taking  place,  the  set  of  error  k  error  dot  coefficients  to  be  varied  for  a 
particular  servo  are  selected  by  typing  the  first  letter  of  that  servo:  (E)levator,  (A)ileron, 
(T)hrottle,  (C)ollective,  or  (R)udder.  From  this  point,  incrementing  or  decrementing  a  transfer 
value  takes  place  by  typing  the  key  from  the  Table  5. 


Table  5.  Control  Keys 


Info: 

(FI) 

(F2) 

(F3) 

(F4) 

(F5) 

(F6) 

(F7) 

Inc: 

Mssam 

Msmm 

(3)Z 

(5)RoU 

(6)Yaw 

(7)Yaw  Gyro 

Dec: 

(Q)X 

(W)Y 

(E)Z 

(T)RoU 

(Y)Yaw 

(U)Yaw  Gyro 

Inc: 

(A)Xdot 

(S)Ydot 

(D)Zdot 

(F)PitchDot 

KeiniBin!™ 

(H)YawDot 

(J)Yaw  Gyro  Dot 

Dec: 

(Z)Xdot 

(X)Ydot 

(C)Zdot 

(N)YawDot 

1  (I)  quit  varying  values  for  this  servo 

(O)display  servo  value  settings  | 

The  Esc  key  works  as  usual  to  stop  the  throttle  &  break  the  real  time  control  mode.  Pressing  a 
function  key  for  information  provides  data  about  the  value  of  the  matrix  coefficients  k  the  change 
rates  for  the  particular  degree  of  freedom. 

The  transfer  matrix  of  control  coefficients  and  the  rates  at  which  they  should  be  varied  :an  be 
saved  to  and  loaded  from  a  DOS  file.  Every  time  FAMEPC  is  executed  from  DOS,  the  file 
generic.coe  is  loaded  into  memory  for  the  transfer  matrix  k  varying  values,  Eind  upon  quitting 
FAMEPC,  the  current  values  are  saved  to  this  file.  Analogous  operations  occur  with  the  file 
generic. cal  for  the  calibration  coefficients. 


D.2.8  Release  3.0,  June  23,  1992. 

D.2.8.1  Modifications. 

FAMEPC. 


Repetitively  Vary  Servo  Control  Values.  The  keyboard  layout  for  varying  servo  control  values 
has  been  changed  to  a  format  similar  to  that  of  a  radio  control  unit.  The  Escape  key  now  sets  the 
throttle  to  its  lowest  level,  acting  as  an  emergency  stop  key.  When  the  throttle  is  at  its  lowest 
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level,  striking  the  equals  sign  or  plus  sign  key  will  set  the  servo  control  values  to  their  defaults. 
Further,  visual  indications  of  the  servo  values  have  been  removed  and  a  tone  is  sounded  after  each 
keystroke.  When  the  limit  has  been  reached,  an  extremely  low  or  high  tone  is  sounded  instead. 

In  the  previous  version,  servo  control  values  were  repetitively  sent  to  the  EVB  as  a  part  of  the 
loop  that  checked  for  keystrokes,  that  is,  they  were  sent  irregardless  of  whether  a  change  was 
requested  at  the  PC’s  keyboard.  Now,  the  servo  control  string  is  sent  to  the  EVB  only  after  a 
keystroke  to  change  the  servo  values  occurs. 

Measure  Step  Response.  The  measure  step  response  option  sends  the  specified  step  impulse  to 
the  EVB  and  saves  data  to  the  specified  file  every  time  the  I  key  is  struck.  The  Q  key  should  be 
struck  to  exit  the  measure  step  response  option.  The  time  measurements  are  recorded  in 
milliseconds,  and  are  based  upon  the  time  that  the  step  occurs,  such  that  the  five  preceding 
samples  have  negative  time  values. 

Calibration.  Calibration  values  now  can  be  downloaded  from  the  EVB,  measured  with  the  PC, 
saved  to  the  PC’s  disk,  and  be  loaded  &om  disk  for  providing  Cartesian  &  Attitude  location  using 
the  PC’s  computational  power,  rather  than  the  EVB.  This  results  in  a  significant  savings  in  time. 

FAMEMAIN.  Code  now  exists  to  transmit  Calibration  CoefiSents  to  PC  upon  receipt  of 
request  as  noted  below  in  Revised  Message  Format  Chart  (Table  6). 

FAMECAL.  Before  saving  calibration  coeffients  to  SRAM,  their  values  are  displayed  so  that 
the  user  can  decide  if  they  are  appropriate. 

FAMEPC,  FAMEMAIN,  &  FAMECAL.  A  number  of  variables’  names  were  changed  to  make 
the  programs  more  consistent. 

D.2.9  Release  2.1,  May  27,  1992  Bugs  Fixed. 
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Table  6.  Revised  Message  Format  Chart 


Key:  S  =  Start  Char,  s  =  Stop  Char,  _  =  Servo  Control  Value,  %  =  Checksum 

Origin 

Message 

Message  String 

PC 

Control  Servos 

SC  %8  (chars  2-11  servo  con.  vals.) 

PC 

Req.  Potentiometer  Vais. 

SQs 

PC 

Request  Position  Values 

SRs 

PC 

Control  Servos  Sc 

Req.  Potentiometer  Vais. 

SS  _ %s 

PC 

Control  Servos  Sc 

Request  Position  Values 

Sc 

ST  _  _%8 

PC 

Request  Calibration  Coef 

SYs 

EVB 

Ack  of  Servo  Control 

SAs 

EVB 

Potentiometer  Values 

SO,AZpot(2),ROLLpot(3),ELpot(4),YAWpot(5), 

Hpot(6),PITCHpot(7),YawDot(8-9), 

Time  Stamp(10-12),%8 

EVB 

Position  Values 

SP,X(2-3),Y(4-5),Z(6-7),RoU(8-9), 

Pitch(10-ll),Yaw(12-13),YawDot(14-15),%8 

EVB 

Calibration  Coefficients 

SV,AZ8lope(2-5),ROLL8lope(6-9), 

ELslope(10-13),  YAW8lope(14-17), 
H8lope(18-21),PITCH8lope(22-25), 
AZdcOff8et(26),ROLLdcOff8et(27), 

ELdcOff8et(28),  YAWdcOfi8et(29), 
HdcOffset(30),PITCHdcOffset(31),%8 

D.2.9.1  FAMEPC.  FAMEPC  can  now  be  changed  between  COM  1  &  COM  2.  Previously  the 
command  to  select  COM  2  wouldn’t  work. 

The  code  for  awaiting  acknowledgement  from  the  EVB  has  been  enhanced.  The  default  delay  is  0 
ms  between  transmissions,  and  it  no  longer  has  any  relation  to  the  amount  of  time  that  FAMEPC 
will  wait  before  timing  out  due  to  a  NAK  (no  acknowledgement^)  from  the  EVB.  FAMEPC  is 
internally  set  to  time  out  if  it  doesn’t  receive  a  response  from  the  EVB  after  3  seconds. 

Version  2.0  of  FAMEPC  concatenated  position  integers  from  the  EVB  into  unsigned  values.  This 
generated  erroneous  values  for  the  position  measurements  sent  from  the  EVB.  Version  2.1 
corrected  this  bug. 


D. 2.9.2  Modifications. 
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OVERALL.  The  FAME  packi^e  now  supports  the  measurement  of  raw  (uncalibrated) 
potentiometer  measurements,  and  FAMEMAIN  will  also  send  position  or  potentiometer  data  to 
the  PC  as  a  part  of  a  Servo  control  request.  The  new  chart  of  PC/EVB  Message  formats  is  in 
Table  7. 


Table  7.  New  Chart  of  PC/EVB  Message  Formats 


Key;  S  =  Start  Char,  s  =  Stop  Char,  .  =  Servo  Control  Value,  %  =  Checksum  | 

Origin 

Message 

Message  String 

PC 

Control  Servos 

SC  .  %s  (chars  2-11  servo  con.  vals.) 

PC 

Req.  Potentiometer  Vais. 

SQs 

PC 

Request  Position  Values 

SRs 

PC 

Control  Servos  & 

Req.  Potentiometer  Vais. 

SS  %s 

PC 

Control  Servos  & 

Request  Position  Values 

& 

ST  %s 

EVB 

Ack  of  Servo  Control 

SAs 

EVB 

Potentiometer  Values 

SO,AZpot(2),ROLLpot(3),ELpot(4),YAWpot(5), 

Hpot(6),PITCHpot(7),YawDot(8-9), 

Time  Stamp(10-12),%8 

EVB 

Position  Values 

SP,X(2-3),Y(4-5),Z(6-7),Roll(8-9), 

Pitch(10-ll),Yaw(12-13),YawDot(14-15),%8 

Upon  requesting  the  Potentiometer  data  using  FAMEPC,  the  user  receives  an  8  bit  response  from 
the  6  potentiometers,  a  16  bit  measurement  of  yaw  dot,  and  a  24  bit  value  of  the  internal  clock  on 
the  EVB  sampled  at  the  end  of  the  function  that  triggers  the  A/D  converter.  The  actual  clock 
consists  of  16  bits;  however,  an  ISR  has  been  added  that  increments  an  8  bit  variable  at  each 
overflow  of  the  timer. 

FAMEPC  has  been  upgraded  to  measure  a  step  response  from  the  helicopter.  This  routine 
prompts  the  user  for  the  file  name  in  which  to  store  the  data,  for  which  Servo  to  provide  the  step 
(Throttle,  Aileron,  Elevator,  Rudder  or  Collective),  and  for  the  change  in  the  value  of  the 
specified  servo. 

Next,  the  routine  places  the  user  into  the  “Servo  Control  with  Keyboard”  mode  so  that  the  user 
can  adjust  the  helicopter  to  the  desired  position.  Upon  pressing  the  (I)  key,  FAMEPC  requests  5 
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potentiometer  measurements,  changes  the  value  of  the  specified  servo,  and  requests  16  more 
potentiometer  measurements.  This  data  is  stored  into  the  PC’s  memory  in  real  time,  and  is 
transferred  to  the  file  after  the  impulse  is  measured.  An  asteriz  is  placed  next  to  the 
measurement  that  occurs  immediately  after  the  step  response  is  executed.  The  file  also  contains 
the  information  specified  by  the  user  preceding  the  step  pulse,  as  well  as  the  setting  of  the  Extra 
delay  between  requests  value. 

We  at  George  Mason  intend  to  measure  the  first  step  responses  from  the  aileron  and  elevator  by 
keeping  the  helicopter  tied  down  with  a  vise,  thus  paying  particular  attention  to  the  pitch  and  roll 
measurements. 

TIME  SPANS.  One  cycle  of  a  position  request  &  response  takes  150  ms.  This  consists  of: 


PC  TX  to  EVB 

A/D  conv,cal 

EVB  TX  to  PC 

PC  display  data 

3  ms 

95  ms 

18  ms 

37  ms 

One  cycle  of  the  new  potentiometer  request  &  response  uses  only  60  ms. 


PC  TX  to  EVB 

A/D  conv. 

EVB  TX  to  PC 

PC  display  data 

3  ms 

2  ms 

15.5  ms 

39.5  ms 

Darrell  Duane 
dduane@fame.gmu.edu 

George  Mason  University  Electrical  &  Computer  Engineering 
November  20,  1992 

D.3  Report  on  the  Fast  Adaptive  Maneuvering  Experiment  (FAME) 

A  copy  of  the  Report  on  the  Fast  Adaptive  Maneuvering  Experiment  (FAME)  can  be  found 
accompanying  the  AFIT  FAME  apparatus.  The  report  is  also  available  in  PostScript  format  via 
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aBonymous  FTP  to  “fame.gmu.edu”.  It  is  stroagiy  advised  to  read  the  entire  report  along  with 
all  supporting  documentation  prior  to  any  attempts  at  manual  flight  control. 

D.S.l  Changes  to  FAME  Report.  The  following  are  a  list  of  changes  and  addenda  to  the 
report  as  a  result  of  the  experimentation  conducted  in  the  course  of  the  research  for  this  thesis. 

•  page  9,  section  2.2.  line  3.  “There  are  two  switches  on  the  plate  which  supports  the 
helicopter.”  These  switches  are  now  attached  to  the  landing  strut  of  the  helicopter.  The 
switches  were  moved  to  permit  easy  removal  of  the  helicopter  for  maintenance  and 
free-flight. 

•  page  10,  section  2.2.1.  Additional  Comment:  The  rudder  control  servo,  located  directly 
below  the  speed  controller  on  the  helicopter,  has  been  repositioned  so  that  the  servo  shaft  is 
located  on  the  opposite  side  of  the  helicopter.  This  was  necessary  due  to  a  rudder  control 
reversal. 

•  page  13,  section  2.3.2.  Additional  comment:  A  9.6  VDC  trickle  charger  has  been  purchased 
in  the  course  of  this  research.  It  will  fully  recharge  the  Nicad  battery  pack  in  12-16  hours. 
Also,  three  12  VDC  Gel-Cell  batteries  are  also  available  for  use.  It  is  important  to  keep  the 
Gel-Cells  fully  charged,  especially  when  storing  the  batteries  for  long  periods  of  time. 

•  page  19,  section  3.9.  The  red  collar  has  been  modified  so  that  it  will  completely  support  the 
helicopter  when  not  flying  and  will  drop  away  as  the  it  gains  altitude.  This  change  helps 
reduce  adverse  yaw  as  the  motor  is  run  up  to  flight  speed. 

•  page  20,  section  3.9.  Fourth  paragraph:  A  metal  stop  has  been  added  to  the  yaw 
potentiometer  mount  to  limit  the  yaw  range  of  motion.  As  delivered,  the  yaw  range  of 
motion  exceeded  the  yaw  potentiometer  range.  The  yaw  range  is  approximately  ±90°. 

•  page  20,  section  3.9.  Last  paragraph:  There  is  not  screw/nut  pair  on  the  collar. 
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•  page  21,  section  3.10.  Connectors  have  been  added  to  permit  quick  and  easy  removal  of  the 
helicopter  from  the  flight  stand.  These  connectors  are  also  standard  R/C  type  to  permit 
connection  to  a  standard  R/C  receiver  for  firee-flight  control.  Also,  the  helicopter  has  been 
secured  to  the  stand  using  plastic  wire  wraps,  again  to  permit  easy  removal. 

•  page  23,  section  5.  The  primary  point  of  contact  for  FAME  at  George  Mason  University  is 
presently  Darrrel  Duane,  &mail  dduaneQmasonl.gmu.edu. 

•  appendices  6.1  through  6.4.  The  supporting  software  for  FAME  has  changed  several  times 
since  the  report  was  issued.  If  desired,  the  code  for  FAMEPC  versions  2.1  through  6.0  is 
available  through  FTP  with  ‘^ame.gmu.edu.”  Appendix  A  contains  the  modified  code 
listing  used  in  this  research. 

•  appendix  6.5.  Additional  drawings  are  provided  documenting  the  DOF  collar  modification. 

D4  AFIT  FAME  User’s  Guide 

D.4  I  Introduction.  The  following  provides  a  brief  overview  of  the  setup  and  operation  of  the 
AFIT  Fast  Adaptive  M2uieuvering  Experiment  (FAME)  apparatus.  Prior  to  any  attempt  at 
operating  the  FAME  apparatus,  recommend  a  thorough  review  of  the  foUowing  documents: 

1.  Report  on  Fast  Adaptive  Maneuvering  Experiment  (FAME)  ((5)) 

2.  Kalt  Electric  Helicopter  Baron  Whisper  Instruction  Manual  (7) 

3.  SKYLARK  R/C  Helicopter  Flight  Simulator  Users  Manual  (3) 

4.  Ray’s  Complete  Helicopter  Manual  R/C  (6)  (optional) 

D.4-2  Hardware.  The  following  is  a  list  of  hardware  items  for  the  AFIT  FAME  apparatus: 

•  386-based  (minimum)  PC  with  at  least  one  comm  port 

•  Skylark  controller  and  I/O  card 
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Figure  24.  DOF  Collar  Modification  (Not  to  Scale) 


•  FAME  apparatus 


-  KALT  Whisper  Electric  Helicopter 

-  Flitemaster  Jr.  IVaining  Stand  (instrumented) 

-  Nicad  Battery,  1350  mAh 

-  Motorola  MC68HC11  microcontroller  unit  (MCU) 

-  MCU  Power  Supply 

•  One  (1)  9.6V  Nicad  Recharger,  Radio  Shack 

•  Three  (3)  12V  Power  Sonic  Gel-Cell  Batteries 

•  Two  (2)  25  lb  concrete  counterweights 

D.4.S  Software  Itutallation.  The  following  is  a  list  of  the  MS-DOS  software  necessary  to 
maintain  and  operate  the  FAME: 

•  Operation 

1.  MS-DOS  2.0  or  higher 

2.  FAMEPC  6.0  (modified  12  Oct  93) 

3.  GENERIC.CAL 

•  Maintenance 

1.  FAMEMAIN.O 

2.  WRTTEJMP.O 

3.  PROCOMM  or  some  other  communications  program 

4.  Borland  C  or  another  MS-DOS  based  C-compUer 
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FAME  will  run  from  a  floppy,  but  if  poasible,  install  FAME  on  the  PC  harddrive. 

The  MS-DOS  file  “generic.cal”  must  also  be  included  in  the  same  directory.  This  file  provides 
values  for  deriving  state  values  from  potentiometer  readings.  Without  this  file,  the  state  values 
will  alway  read  zero. 

D.4-4  Operational  Instructions.  To  start  the  FAME  program,  at  MS-DOS  prompt  type 
FAMEPC.  The  FAME  menu  should  appear  (Figure  25). 

D.4.41  Menu  Selection  Summary. 

•  (J)  -  allows  joystick  control  of  the  helicopter,  but  does  not  record  the  state  or  servo  values. 

•  (G)  -  activates  control  of  the  helicopter  using  the  joystick  and  stores  the  servo  and  state 
values  in  the  file  “filel.trn”.  Recording  time  is  limited  to  approximately  thirty  seconds.  If 
allowed  to  record  for  a  longer  period,  the  program  empties  the  file  and  no  longer  records 
data.  Also,  any  subsequent  recordings  will  overwrite  the  data  currently  in  ‘^el.trn”.  To 
save  the  data,  after  each  recording  rename  '^el.tm.”  The  format  of  ‘^el.tm”  as  read  left 
to  right:  time(sec),  elevator,  aileron,  throttle,  collective,  rudder,  pitch,  roll,  altitude, 
y-coordinate,  yaw,  x-coordinate,  and  yaw-dot. 

•  (C)  -  calibrates  the  joystick  and  stores  values  in  ’^joy.cal”. 

•  (S)  -  Displays  realtime  state  values  (pitch,  roll,  alt,  y-coord,  yaw,  x-coord,  yaw-dot). 

•  (X)  -  Display  realtime  raw  potentiometer  values  (H  pot,  Az  pot,  El  pot,  pitch,  roll,  yaw, 
gyro). 

•  (Q)  -  Exit  program 
D.4.5  Flight  Operation. 
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WARNING.  Although  small  and  battery  powered,  the  Kalt  Helicopter  is  not  a  toy.  Strongly 
advise  reading  all  documentation  on  the  Kalt  Helicopter,  FAME  apparatus,  with  special  attention 
paid  to  the  warning  and  safety  recommendations.  Prior  to  attempting  to  operate  the  FAME 
helicopter,  also  strongly  recommend  spending  time  with  the  SKYLARK  simulator  program.  It  is 
also  advisable  to  spend  a  few  hours  of  instruction  with  an  experienced  R/C  helicopter  pUot. 

The  following  is  a  step-by-step  guide  to  the  operation  of  the  AFIT  FAME  apparatus.  It  is  only  a 
euide  and  is  not  intended  to  stand  alone.  The  user  should  still  read  all  accompan3ring 
documentation  on  FAME  and  the  AFIT  FAME  apparatus. 

1.  Ensure  flight  area  is  clear  of  all  obstacles  within  the  flight  radius  of  the  FAME  apparatus. 

2.  Place  the  FAME  apparatus  on  a  smooth  surface  (floor).  Place  counterweights  on  the 
plywood  platform  opposite  the  helicopter.  Also  place  the  MCU  power  supply  and  the 
helicopter  power  supply  (batteries)  on  the  platform.  Connect  the  RS-232  to  the  PC. 
Connect  all  power.  By  hand,  move  the  training  stand  through  all  range  of  motion  while 
checking  for  binding  or  wires  caught  in  the  training  stand  joints. 

3.  To  prevent  accidental  throttle  application,  DO  NOT  activate  the  motor  (press  the  red 
button)  while  the  FAME  program  is  in  joystick  control  (J)  or  (G)  at  this  point.  When 
starting  joystick  control,  ensure  the  throttle  is  set  at  lowest  level  (full  down). 

4.  Turn  on  all  power  to  the  PC,  MCU  and  helicopter.  DO  NOT  press  the  red  button  near  the 
helicopter  power  switch  at  this  time.  A  high  pitched  whine  should  be  heard  from  the 
helicopter  gyro  and  the  LED  indicator  on  the  motor  controller  should  be  green.  If  not,  then 
power  is  not  being  provided  to  the  helicopter.  Check  power  leads  and  the  30  Amp  fuse  on 
the  motor  controller. 

5.  Start  FAMEPC  by  typing  “f  amepc”  at  the  MS-DOS  prompt.  Check  communications  to  the 
MCU  by  selecting  (S)  or  (X).  The  appropriate  state  or  potentiometer  values  should  be  seen. 
If  not,  power  down  and  recheck  all  connections. 
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6.  If  joystick  has  not  been  previously  calibrated,  select  (C)  and  follow  instructions  to  calibrate 
joystick.  The  calibration  data  is  stored  on  disk  in  ‘‘joystick.cal” .  Calibration  will  not  be 
necessary  later. 

7.  Select  (J)  or  (G).  Check  flight  control  by  moving  the  joystick  controls  and  observing  servo 
movements.  Check  throttle  by  observing  LED  readout  on  the  motor  controller.  LED  should 
change  from  green  to  yellow  then  red  as  the  throttle  is  increased.  Hit  any  key  to  terminate 
joystick  control. 

8.  Ensure  the  area  around  the  helicopter  rotor  is  clear.  Check  that  the  throttle  is  set  at  lowest 
position  (full  down).  Select  (J)  or  (G)  to  activate  joystick  control.  Check  the  LED  readout 
on  the  speed  controller.  If  green,  it  is  safe  to  enable  the  motor  by  pressing  the  red  button  on 
the  helicopter.  Move  to  a  safe  distance  and  slowly  apply  throttle  while  observing  the  main 
and  tail  rotors.  Throttle  down  immediately  if  any  unusual  vibration  occurs  or  the  rotors 
strike  an  object.  If  helicopter  begins  to  perform  erratically  or  becomes  uncontrollable, 
immediately  power  down  the  helicopter  by  disconnecting  the  battery  or  DC  power  supply. 
Alternately,  turn  of  the  MCU  power  supply.  This  will  cause  all  servos  and  the  motor 
controller  to  return  to  the  neutral  setting. 

9.  To  end  flight  control,  slowly  move  the  throttle  to  the  lowest  position.  After  all  movement 
has  stopped  strike  any  key  to  terminate  joystick  control.  Place  main  power  switch  on 
helicopter  in  the  “ofP  position. 

10.  If  subsequent  flights  are  to  be  recorded,  rename  “filel.tm”  or  the  data  recorded  will  be 
overwritten  by  the  newer  data. 

D.4-6  Troubleshooting  Guide.  The  following  table  summarizes  some  of  the  more  common 
problems  encountered  when  operating  FAMEPC. 
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Table  8.  Troubleshooting  Guide 


Problem 

Possible  Cause 

Solution 

Receiving  NAKs  after 
selecting  (S)  or  (X) 

No  data  path 

No  power  to  MCU 

Check  RS-232  connection 

Check  power  to  MCU 

Wrong  port 

Check  COMl 

MCU  memory  erased 

Reload  PAMEMAIN.O 
and/or  WRITEJMP.O 

Jumper  J4  on  MCU 
in  wrong  position 

Check  J4  in  2-3 
position 

Data  file  fails  to  record 

Disk  is  full 

Remove  files  as  necessary 

Flight  time  was 
longer  than  30  seconds 

Record  data  again 
over  shorter  time 
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